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Abstract 


Title  of  Dissertation:  Averaging  and  Motion  Control 

of  Systems  on  Lie  Groups 

Naomi  Ehrich  Leonard,  Doctor  of  Philosophy,  1994 

Dissertation  directed  by:  Professor  P.S.  Krishnaprasad 

Department  of  Electrical  Engineering 


In  this  dissertation,  we  study  motion  control  problems  in  the  framework  of 
systems  on  finite-dimensional  Lie  groups.  Nonholonomic  motion  control  prob¬ 
lems  are  challenging  because  nonlinear  controllability  theory  does  not  provide 
an  explicit  procedure  for  constructing  controls  and  linearization  techniques,  typ¬ 
ically  effective  for  nonlinear  system  analysis,  fail  to  be  useful.  Our  approach, 
distinguished  from  previous  motion  control  research,  is  to  exploit  the  Lie  group 
framework  since  it  provides  a  natural  and  mathematically  rich  setting  for  studying 
nonholonomic  systems.  In  particular,  we  use  the  framework  to  develop  explicit, 
structured  formulas  that  describe  system  behavior  and  from  these  formulas  we 
derive  a  systematic  way  of  synthesizing  controls  to  achieve  desired  motion. 

As  our  main  tool  we  derive  averaging  theory  for  left-invariant  systems  on 
finite-dimensional  Lie  groups.  This  theory  provides  basis-independent  formulas 


which  approximate  system  behavior  on  the  Lie  group  to  arbitrarily  high  order  in 
t  given  small  (e)  amplitude,  periodically  time-varying  control  inputs.  We  inter¬ 
pret  the  average  formulas  geometrically  and  exploit  this  interpretation  to  prove 
a  constructive  controllability  theorem  for  the  average  system.  The  proof  of  this 
theorem  provides  a  constructive  control  synthesis  methodology  for  drift-free  sys¬ 
tems  which  we  use  to  derive  algorithms  which  synthesize  sinusoidal  open-loop 
controls.  We  apply  the  algorithms  to  several  under-actuated  mechanical  control 
problems  including  problems  in  spacecraft  attitude  control,  unicycle  motion  con¬ 
trol  and  autonomous  underwater  vehicle  control.  We  illustrate  the  effectiveness 
of  the  synthesized  controls  by  simulation  and  experimentation.  We  show  fur¬ 
ther  that  as  a  consequence  of  the  geometry  inherited  from  the  average  formulas, 
our  algorithms  can  be  used  to  produce  motion  controls  that  adapt  to  changes  in 
control  authority  such  as  loss  of  an  actuator. 

We  also  apply  our  theory  to  synthesize  controls  for  bilinear  control  systems  on 
5Rn  possibly  with  drift.  Our  approach  is  to  control  the  system  state  by  controlling 
the  state  transition  matrix  which  evolves  on  a  matrix  Lie  group.  We  design  and 
demonstrate  a  controller  for  an  example  system  with  drift,  a  simple  switched 
electrical  network. 
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Chapter  1 


Introduction 


Lie  groups  provide  both  a  natural  and  a  mathematically  rich  setting  for  studying 
a  variety  of  motion  control  problems.  For  motion  control  problems  involving 
rotating  and  translating  bodies,  such  as  space  systems,  underwater  vehicles  or 
mobile  robots,  the  natural  appearance  of  certain  Lie  groups  derives  from  the  fact 
that  these  describe  the  system  configuration  space  or  a  piece  of  it.  For  instance, 
there  is  a  one-to-one  relationship  between  the  matrix  Lie  group  of  rotations, 
SO (3),  and  all  possible  orientations  of  a  rigid  body.  This  is  not  true  for  local 
parametrizations  such  as  Euler  angles  and  quaternions.  Further,  the  kinematics  of 
the  rotating  body  can  be  described  by  a  left  (or  right)  invariant  system  on  50(3). 
Left  (or  right)  invariance  implies  that  the  kinematic  description  is  independent  of 
how  we  choose  to  map  orientations  to  elements  in  50(3),  i.e. ,  which  orientation 
corresponds  to  the  identity  element  of  50(3). 

Subgroups  of  GL(n),  the  general  linear  Lie  group,  arise  in  a  natural  way  in  the 
study  of  the  state  transition  matrix  of  a  time- varying  linear  system  on  9?n.  For 
example,  consider  a  passive  electrical  network  with  ideal  switches  described  by  a 
time- varying  linear  system  of  state  equations.  Suppose  that  energy  is  conserved 


1 


such  that  the  state  of  the  system  evolves  on  an  n-dimensional  sphere  (see  Chap¬ 
ter  6  for  an  example) .  Then  the  state  transition  matrix  for  the  network  naturally 
evolves  (“moves”)  in  the  space  of  n-dimensional  rotation  matrices,  i.e.,  the  matrix 
Lie  group  SO(n).  This  group  is  the  “configuration”  space  of  the  state  transition 
matrix  because  it  intrinsically  incorporates  “configurational”  constraints,  e.g., 
that  the  state  transition  matrix  must  be  orthogonal. 

During  the  second  half  of  the  nineteenth  century,  Sophus  Lie  introduced  and 
developed  his  ideas  on  continuous  transformation  groups  that  leave  mathemat¬ 
ical  systems  invariant  (later  named  Lie  groups).  Lie’s  focus  was  the  theory  of 
differential  equations  [65,  51].  However,  since  then  Lie  groups  have  played  an 
important  role  in  many  diverse  areas  of  mathematics  and  physics  including  dif¬ 
ferential  geometry,  mechanics  and  particle  physics.  More  recently,  Lie  groups 
have  found  their  way  into  the  controls  literature. 

In  his  seminal  work  in  the  early  1970’s,  Roger  Brockett  put  the  theory  of 
Lie  groups  and  their  associated  Lie  algebras  into  the  context  of  nonlinear  control 
theory  to  express  notions  such  as  nonlinear  controllability,  observability  and  real¬ 
ization  theory  for  right-invariant  systems  evolving  on  matrix  Lie  groups  [11].  Ju- 
rdjevic  and  Sussmann  further  investigated  the  controllability  properties  of  these 
systems  on  abstract  Lie  groups  [29] .  One  of  the  most  important  insights  derived 
from  this  work  was  the  recognition  that  questions  about  these  kinds  of  systems  on 
Lie  groups  can  be  reduced  to  questions  about  their  associated  Lie  algebras.  Since 
Lie  algebras  are  vector  spaces  whereas  Lie  groups  are  manifolds,  this  reduction 
greatly  simplifies  the  problem. 

In  this  dissertation  we  study  motion  control  problems  in  the  abstract  frame- 
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work  of  left  (or  right)  invariant  systems  on  finite-dimensional  Lie  groups.  Our 
main  objectives  are 

1.  To  describe  the  solutions  of  these  systems  on  Lie  groups,  i.e.,  to  understand 
the  motion  of  these  systems  given  certain  types  of  input. 

2.  To  derive  from  the  solutions  a  systematic  way  of  synthesizing  controls  to 
achieve  desired  motion. 

The  Lie  group  framework  is  exploited  to  get  coordinate-free  descriptions  of  motion 
and,  consequently,  generalized  control  synthesis  algorithms. 

The  results  of  Brockett,  Jurdjevic  and  Sussmann  provide  a  simple  test  to  de¬ 
termine  for  a  given  motion  control  problem,  expressed  as  a  left  (or  right)  invariant 
system  on  a  Lie  group,  whether  or  not  there  exists  a  control  law  that  drives  the 
system  from  any  initial  point  in  the  Lie  group  to  any  final  point  in  the  Lie  group. 
However,  the  test,  which  we  refer  to  as  the  Lie  algebra  controllability  rank  con¬ 
dition,  by  itself  does  not  explicitly  reveal  the  control  law  nor  how  the  system 
will  move.  Unlike  the  linear  setting  where  the  controllability  Grammian  yields 
constructive  controls,  here  the  rank  condition  does  not  lead  immediately  to  an 
explicit  procedure  for  constructing  controls.  Finding  a  control  law  that  results  in 
the  desired  motion  is  referred  to  as  the  constructive  controllability  problem.  This 
problem  is  considered  challenging  because  linearization  techniques,  highly  effec¬ 
tive  in  the  analysis  of  nonlinear  systems,  fail  to  be  useful.  In  fact,  the  linearized 
system  is  generally  not  controllable. 

We  approach  the  constructive  controllability  problem  and  our  main  objectives 
by  considering  small-amplitude,  periodically  time-varying  controls  and  using  av¬ 
eraging  theory  as  our  main  analysis  tool.  The  primary  motivation  for  motion 
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control  based  on  small-amplitude  periodic  controls  comes  from  nonlinear  systems 
theory  and,  in  particular,  from  the  theory  of  systems  with  nonholonomic  con¬ 
straints.  However,  the  use  of  small-amplitude  periodic  controls  is  also  practically 
motivated.  For  example,  one  of  the  applications  of  our  work  is  the  spacecraft 
attitude  control  problem  with  two  internal  rotors.  We  consider  a  spacecraft  for 
which  we  can  control  roll  and  pitch,  but,  perhaps  due  to  an  actuator  failure,  we 
assume  no  direct  control  over  yaw.  The  motion  control  problem  is  then  to  show 
how  to  orient  the  spacecraft  as  desired,  e.g.,  to  achieve  a  net  yaw  rotation,  using 
small-amplitude  periodic  changes  (wiggles)  in  roll  and  pitch  velocity.  The  choice 
of  small-amplitude,  low-frequency  periodic  controls  in  this  application  is  certainly 
justified  from  a  practical  point  of  view.  Using  these  small,  gentle  control  inputs, 
we  can  avoid  both  exciting  vibrational  modes  of  the  system  and  making  large 
off-course  excursions  in  the  vehicle’s  orientation.  Further,  because  of  the  nature 
of  these  controls,  it  is  possible  to  consider  producing  them  with  micro-actuators, 
e.g.,  vibratory  actuators.  These  types  of  actuators  would  have  the  advantage 
of  small  size  and  weight  in  applications  such  as  the  control  of  small  planetary 
spacecraft. 

Control  synthesis  based  on  small-amplitude  periodic  controls  can  also  be  ap¬ 
plied  to  the  design  of  micro-actuators  and  sensors.  For  example,  vibratory  actu¬ 
ators,  such  as  piezoelectric  actuators,  are  driven  by  small-amplitude  mechanical 
oscillations  which  need  to  be  rectified  into  linear  or  rotary  motion.  Brockett  has 
studied  this  type  of  problem  [14].  Our  results  can  be  applied  to  interesting  types 
of  vibratory-driven  sensors  or  actuators  that  naturally  fit  the  Lie  group  frame¬ 
work.  We  discuss  one  such  possibility,  namely  an  actuator  that  uses  a  sphere 
which  rolls  between  two  flat  surfaces  to  convert  vibratory  motion  into  rotary 
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motion. 


From  the  theoretical  point  of  view,  it  is  the  observations  and  results  from 
studies  of  nonholonomic  systems,  i.e.,  systems  that  satisfy  nonholonomic  con¬ 
straints,  that  provide  inspiration  for  our  approach.  These  studies  are  relevant  to 
our  problem  because  the  mechanical  systems  that  we  consider  in  the  Lie  group 
framework  satisfy  nonholonomic  kinematic  constraints.  Nonholonomic  kinemat¬ 
ics  constraints  are  nonintegrable  velocity  constraints,  i.e.,  constraints  on  velocities 
that  cannot  be  expressed  as  configurational  constraints. 

For  example,  a  unicycle  with  a  wheel  that  rolls  and  turns  may  be  subject 
to  a  nonholonomic  no-slip  constraint,  i.e.,  the  condition  that  the  wheel  does  not 
slip  sideways.  This  constrains  the  wheel’s  possible  velocities  but  does  not  con¬ 
strain  the  unicycle’s  possible  positions  and  orientations.  Alternatively,  a  space 
system  with  no  spin  and  no  external  torques  applied  will  conserve  (zero)  angular 
momentum.  This  conservation  law  can  equivalently  be  expressed  as  a  noninte¬ 
grable  constraint  on  the  spacecraft’s  angular  velocity.  Yet  another  example  of 
a  nonholonomic  system  is  a  low  Reynolds  number  swimmer,  e.g.,  a  paramecium 
which  has  negligible  inertia  relative  to  friction.  The  swimmer  is  constrained  by 
a  no-slip  condition  between  its  body  and  the  fluid,  i.e.,  the  tangential  velocity 
between  body  and  fluid  is  zero.  These  conditions  together  with  the  low  Reynolds 
number  limit  yield  nonintegrable  kinematic  constraints  on  the  swimmer. 

The  motion  of  systems  in  free  fall  or  in  space  which  conserve  angular  momen¬ 
tum  has  been  studied  in  the  context  of  both  animate  and  inanimate  bodies.  Kane 
and  Scher  derived  dynamic  models  and  explanations  for  the  “falling  cat”  problem, 
i.e.,  the  problem  of  how  a  cat  when  dropped  upside  down  reorients  itself  while 
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conserving  angular  momentum  [30].  Frohlich  investigated  the  dynamics  of  how 
springboard  divers,  gymnasts  and  trampolinists  rotate  and  reorient  themselves 
in  free  fall  [22],  Using  the  theory  of  connections  in  principal  bundles,  Krish- 
naprasad,  Yang  and  Dayawansa  studied  kinematic  drift  (or  geometric  phase)  ef¬ 
fects  and  related  optimal  control  problems  in  space  systems  subject  to  vibrations 
or  articulations  [35,  36,  79].  Montgomery,  also  using  the  setting  of  a  principal 
bundle  with  connection,  investigated  the  optimal  control  problem,  referred  to 
as  the  isoholonomic  problem,  of  finding  the  lowest-energy  cyclic  “shape”  change 
yielding  a  desired  phase  shift  [56].  His  results  were  applied  to  several  examples 
including  the  falling  cat  problem.  Sreenath  studied  controllability  and  control 
synthesis  for  reorientation  of  planar  multibody  systems  in  space  using  reduction 
[72]. 

Taylor  [74,  75]  and  Lighthill  [52]  both  made  early  contributions  to  the  study  of 
how  microscopic  organisms  use  cyclic  (periodic)  shape  changes  to  swim.  Purcell 
investigated  these  low  Reynolds  number  swimmers  further,  exploring  possible 
efficient  swimming  and  feeding  strategies  [63].  Using  the  familiar  (to  physicists) 
formalism  of  gauge  theory,  Wilczek  and  Shapere  derived  a  unifying  geometric 
framework  for  studying  how  deformable  bodies  move.  Using  this  framework  they 
were  able  to  study  problems  including  the  falling  cat,  the  diver  as  well  as  the  low 
Reynolds  number  swimmer  [68,  69]. 

In  the  robotics  literature  researchers  have  recently  become  interested  in  non- 
holonomic  motion  planning  for  wheeled,  mobile  robots  with  wheels  subject  to 
the  no-slip  constraint.  The  problem  is  finding  feasible  trajectories  within  the 
set  of  admissible  trajectories.  Early  work  was  devoted  to  path-planning  for  low¬ 
dimensional  wheeled  mobile  robots  beginning  with  Laumond  [39,  40]  and  Bar- 
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raquand  and  Latombe  [7]. 


More  recently,  the  constructive  controllability  problem  for  nonholonomic  sys¬ 
tems  of  a  more  general  form  has  been  studied.  Nonholonomic  systems  can  be 
described  in  state-space  form,  at  least  locally,  as  drift-free  systems  on  5Rn  of  the 
form 

m 

x  =  ^2  Fi(x)ui,  xeUn,  n  >  m.  (1.1) 

i=i 

System  (1.1)  is  called  drift-free  because  x  =  0  if  u  =  (ui, . . . ,  um)  =  0,  i.e.,  the 
system  does  not  “drift”  when  there  is  no  control  applied. 

Brockett  investigated  optimal  controls  to  steer  a  prototype  (nilpotent)  class  of 
such  systems,  providing  motivation  for  later  work  [13].  Murray  and  Sastry  used 
(suboptimal)  sinusoidal  controls  to  steer  systems  which  can  be  expressed  in  a 
special,  nilpotent  form  called  “chained”  form  [58,  60].  They  showed  when  and  how 
systems  of  the  form  (1.1)  could  be  transformed  into  chained  form  [59].  Lafferiere 
and  Sussmann  derived  a  general  strategy  for  steering  controllable  systems  of 
the  form  (1.1)  based  on  an  extended  system  to  (1.1)  and  formal  calculations 
on  the  free  nilpotent  Lie  algebra  generated  by  the  system  vector  fields  [38,  37]. 
For  nilpotent  or  feedback  nilpotentizable  systems  the  generated  controls  steer  the 
system  exactly  as  desired.  Liu  and  Sussmann  developed  highly  oscillatory  control 
solutions  to  approximate  general  paths  with  feasible  trajectories  of  systems  of 
the  form  (1.1)  [73,  53].  In  particular,  using  averaging  theory  they  show  that 
the  approximation  converges  to  the  desired  path  in  the  limit  as  the  oscillation 
frequency  (and  amplitude)  goes  to  infinity.  Gurvits  and  Li  also  considered  highly 
oscillatory  controls  to  solve  the  motion  planning  problem  for  system  (1.1)  [24,  25]. 
Their  solution  uses  averaging  theory,  but  their  algorithm  is  recursive.  Brockett 
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and  Dai  studied  the  role  of  elliptic  functions  in  optimal  paths  for  nonholonomic 
systems  [16]. 

In  Chapter  2  of  this  dissertation,  we  formally  state  the  motion  control  problem 
in  the  framework  of  systems  on  Lie  groups.  We  discuss  left  and  right-invariant 
systems  with  and  without  drift  on  matrix  and  abstract  Lie  groups.  We  review 
definitions  and  basic  theorems  from  nonlinear  controllability  theory  and  define 
geometric  objects  that  play  a  key  role  in  the  averaging  theory  of  Chapter  4.  We 
also  describe  two  local  representations  of  the  solution  to  the  Lie  group  systems, 
one  a  product  of  exponentials  and  the  other  an  exponential  of  a  sum,  that  form 
the  basis  for  our  extension  of  classical  averaging  theory  to  systems  on  Lie  groups. 

In  Chapter  3  we  derive  examples  that  are  featured  throughout  the  dissertation 
including  the  spacecraft  attitude  control  problem,  the  unicycle  motion  planning 
problem  and  the  motion  control  problem  for  an  autonomous  underwater  vehicle 
(AUV). 

Chapter  4  introduces  averaging  theory  for  systems  on  Lie  groups.  The  purpose 
is  to  derive  an  approximation  to  the  Lie  group  system  solution  to  arbitrarily 
high  order  in  the  small  parameter  e  which  represents  the  small  amplitude  of 
the  oscillatory  control  inputs.  Although  there  is  in  general  no  analytic  solution 
that  describes  the  motion  for  a  given  control  input,  we  show  that  there  is  an 
analytic  average  approximation  to  the  solution  that  captures  the  essence  of  the 
motion  and  helps  us  meet  Objective  1  above.  The  average  solution  provides 
a  basis-independent  formula  for  the  system’s  motion  with  an  intrinsic  geometric 
interpretation.  For  instance,  the  second-order  average  formula  can  be  interpreted 
as  an  “area  rule”  and  higher-order  average  formulas  as  “area-moment  rules”. 
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We  emphasize  the  coordinate-free  aspect  of  the  solution  by  illustrating  how  the 
important  secular  term  in  the  area  rule  derives  from  the  curvature  form  of  a 
certain  principal  fiber  bundle  with  connection  (see  Section  4.3.1  for  a  definition 
of  principal  fiber  bundles  and  connections).  We  also  discuss  some  implications 
for  system  stability  that  are  associated  with  the  averaging  theory. 

In  Chapter  5  we  address  Objective  2,  control  synthesis,  by  relating  average 
formulas  of  Chapter  4  to  system  controllability.  Specifically,  in  order  to  drive 
a  given  system’s  motion  as  desired,  we  propose  synthesizing  controls  that  drive 
the  average  motion  of  the  system  as  desired,  knowing  from  our  averaging  theory 
results  that  the  true  motion  will  stay  close  to  the  average  motion.  A  critical 
ingredient  in  this  strategy  is  determining  the  minimum  order  of  the  average  so¬ 
lution  that  can  be  controlled  as  desired,  i.e.,  that  captures  the  controllability  of 
the  system.  We  prove  a  constructive  controllability  theorem  that  shows  that  this 
order  is  one  more  than  the  number  of  Lie  bracket  iterations  needed  for  the  system 
to  satisfy  the  Lie  algebra  controllability  rank  condition.  Additionally,  the  proof 
of  this  theorem  provides  a  methodology  for  constructing  controls  to  direct  the 
average  motion  as  desired. 

In  the  second  part  of  Chapter  5  we  use  the  constructive  methodology  to  derive 
algorithms  that  systematically  synthesize  open-loop,  sinusoidal  controls  for  point- 
to-point  system  maneuvers  of  systems  which  require  up  to  depth-two  Lie  brackets 
to  satisfy  the  Lie  algebra  controllability  rank  condition.  The  algorithms  are 
illustrated  for  the  examples  of  Chapter  3  with  simulations  for  verification.  Based 
on  the  capabilities  of  this  open-loop  control  synthesizer,  we  propose  a  control 
architecture  for  motion  control  systems  which  uses  a  strategic  open-loop  planner 
coupled  with  intermittent  feedback  plus  a  second  level  of  feedback  which  provides 
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adaptation  to  changes  in  control  authority  such  as  an  actuator  failure.  We  also 
describe  an  experiment  that  was  run  to  test  the  algorithms  on  an  underwater 
vehicle  in  a  neutral  buoyancy  tank  at  the  University  of  Maryland. 

In  Chapter  6  we  turn  to  the  problem  of  open-loop  control  synthesis  for  bilinear 
systems  on  9?n  with  state  transition  matrices  that  evolve  on  matrix  Lie  groups. 
We  apply  the  theory  of  averaging  and  motion  control  on  Lie  groups  to  the  problem 
of  controlling  energy  transfers  between  dynamic  storage  elements  in  switched 
electrical  networks.  In  this  case  the  system  is  a  right-invariant  system  on  a 
matrix  Lie  group  with  drift.  We  show  for  a  system  on  50(3)  that  our  techniques 
can  be  used  to  accomplish  prescribed  energy  transfers  with  a  finite  number  of 
switchings,  and,  thus,  chattering  problems  associated  with  feedback  strategies 
such  as  sliding  mode  control  can  be  avoided. 

In  Chapter  7  we  describe  our  conclusions  and  suggestions  for  future  work. 

The  major  contributions  of  this  dissertation  include  the  theory  of  averaging 
for  systems  on  finite-dimensional  Lie  groups  and  the  derivation  of  a  system¬ 
atic  method,  low  in  computational  burden,  for  synthesizing  open-loop,  small- 
amplitude  periodic  controls  for  these  types  of  systems.  These  contributions  are 
distinguished  from  past  results  in  nonholonomic  motion  planning  most  clearly  by 
the  use  of  averaging  in  the  abstract  framework  of  motion  control  on  Lie  groups 
which  yields  intuitive,  geometric,  basis-independent  solutions  to  motion  control 
problems.  In  essence,  we  have  systematized  the  means  to  solve  motion  control 
problems  that  can  be  represented  in  our  “normal”  form,  i.e.,  as  left  (or  right) 
invariant  systems  on  finite-dimensional  Lie  groups.  For  our  previous  related  pub¬ 
lications  see  Leonard  and  Krishnaprasad  [42,  43,  44,  45,  46,  47,  48,  49,  50]. 
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Chapter  2 


Preliminaries 


In  this  chapter  we  present  the  formal  framework  of  motion  control  on  Lie  groups. 
We  begin  with  a  definition  of  a  control  system  on  an  abstract  finite-dimensional 
Lie  group  and  specialize  to  systems  on  matrix  Lie  groups.  After  reviewing  def¬ 
initions  and  theorems  concerning  nonlinear  controllability,  we  define  geometric 
objects  significant  for  the  motion  description  formulas  in  Chapter  4  and  the  con¬ 
trol  algorithm  of  Chapter  5.  The  chapter  ends  with  a  discussion  of  two  important 
local  solutions  to  systems  on  Lie  groups.  These  local  solutions  provide  the  means 
to  extend  classical  averaging  theory  to  systems  on  Lie  groups. 


2.1  Problem  Definition 


In  this  section  we  define  Lie  groups  and  Lie  algebras  and  state  the  motion  control 
problem  in  the  framework  of  systems  on  Lie  groups.  Useful  references  are  [1,  12, 
19,  26,  27,  76]. 
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2.1.1  Lie  Groups  and  Lie  Algebras 

A  Lie  group  G  is  a  differentiable  manifold  which  is  also  a  group,  such  that  multi¬ 
plication  and  inversion  of  elements  are  smooth  maps.  Let  h  e  G,  and  define  left 
translation  Lh  :  G  — >•  G  and  right  translation  Rh  :  G  — »  G  by  h  as 

Lh{g)  =  hg ,  Rh(g)  =  gh,  g  E  G, 

respectively.  A  vector  field  Y  on  G  is  left-invariant  if 

(Lh).Y  =  Y,  Vhe  G, 

where  (Lh)*  is  the  differential  of  Lh.  Equivalently,  TgLhY (g)  —  Y (hg),  Vg,  h  E  G, 
where  TgLh  is  the  linearization  of  Lh  at  g.  Similarly,  Y  is  right-invariant  if 

(Rh)*Y  =  Y,  Vhe  G, 

i.e.,  TgRhY(g)  =  Y(gh),  Vg,hE  G. 

A  Lie  algebra  Q  over  K  is  a  real  vector  space  endowed  with  a  binary  operation 
[v]  :  Q  x  Q  Q,  called  the  Lie  bracket,  which  satisfies  (i)-(iii)  below  V£,  rj,  (  e  G, 
Va,  0  e  5R: 

(i)  (Bilinearity)  [af  +  fig,  C]  =  a[f,  C]  +  P[g,  C], 

(ii)  (Skew  Symmetry)  [C,  r?]  =  —[77,  ^], 

(iii)  (Jacobi  Identity)  [£,  [77,  C]]  +  [v,  [C,  C]]  +  [C,  [?,  v]]  =  0- 

To  each  finite-dimensional  Lie  group  G  we  associate  a  finite-dimensional  Lie  al¬ 
gebra  Q  which  can  be  identified  with  TeG,  the  tangent  space  (i.e.,  the  linear 
approximation)  of  G  at  the  identity  e  e  G.  G  and  Q  have  the  same  dimension. 
Further,  TeG  is  isomorphic  to  the  Lie  algebra  of  left-invariant  vector  fields  on  G 
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(see  e.g.,  [76]).  In  particular,  a  vector  field  Y  on  G  is  left-invariant  if  and  only  if 
Y ( g )  =  TeLg  •  £,  Vg  G  G  for  some  fixed  £  G  Q.  To  see  this  note  that  for  h  G  G 

Y(hg)  =  TeLhg  ■  £  =  Te(Lh  o  La)  ■  £  =  (TgLh)(TeLg)  •  £  =  TgLhY(g). 

Similarly,  Y  is  right-invariant  if  Y (g)  —  TeRg  •  £,  Vg  G  G  for  some  fixed  £  G  Q. 

For  Yi  and  Yj  smooth  vector  fields  on  a  smooth  manifold  M  the  Lie  bracket 
[Tj,  Yj]  is  defined  by 

[Yi,Yj\(f)  =  X(Y(f))-Y(X(f)) 

where  /  is  a  smooth  real-valued  function  on  M.  Given  £*,£,■  G  G,  let  Y{  =  (L9)*£i 
and  Yj  =  (Lg)^j.  Then  Yi  and  Yj  are  smooth  left-invariant  vector  fields  on 
G.  The  Lie  bracket  on  Q  =  TeG  is  defined  in  terms  of  the  Lie  bracket  on  the 
associated  left-invariant  vector  fields  as 


{Y,  Yj]  =  [(£,).&,  (LjUj]  =  (L,).[fi, {,],  S,  (j  e  e, 

where  the  first  two  brackets  are  brackets  defined  on  the  vector  fields  and  the 
bracket  on  the  right  is  the  Lie  bracket  defined  for  Q. 

Given  £  G  G,  define  =  TeLg  ■  £,  and  let  the  integral  curve  of  passing 
through  e  at  t  =  0  be  denoted  by 

exp^  :SR-4G:  4  i — >■  exp^(t)  =  exp(£t). 

Then  exp^  is  a  one-parameter  subgroup  of  G,  i.e.,  exp^(s  +  t)  =  exp^(s)  exp^(t) 
and  exp^1(t)  =  exp^(— t).  We  define  the  exponential  map  of  G  into  G  by 

exp  :  Q  — >  G  :  £  exp(£)  =  exp?(l)  (2.1) 
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Then  exp  is  a  diffeomorphism  of  a  neighborhood  of  0  £  Q  onto  a  neighborhood 
of  e  6  G  [76]. 

We  define  a  (left)  action  of  a  Lie  group  G  on  a  smooth  manifold  Q  by  the 
smooth  mapping 

$:GxQ^Q:  (g,  q)  i->  $(g,  q)  =  $g(q)  =  g  ■  q,  (2.2) 

®(e,q)  =  q,  $(g,$(h,q))  =  &(gh,q),  Vg,  h  £  G,  Vq  £  Q. 

For  example,  we  define  the  adjoint  action  of  G  on  Q  by 

Ad  :  G  x  Q  -*  g  :  (<*,£)  ^  Ad^  =  Te(Rg-iLg )  •  £.  (2.3) 

For  a  group  action  (2.2),  the  infinitesimal  generator  of  the  action  corresponding 
to  £  G  Q  is  defined  by 

£d(q)  =  4  ^(exp  (&),q),  VqeQ.  (2.4) 

ai  t=o 

For  the  adjoint  action  of  (2.3), 

&(»?)  =  ad*»/=[f,»7],  Vqeg. 

We  define  the  iterated  ad  operator  by 

ad^?7  =  ad^(adfl_1?7),  ad?°7?  —  77,  £,  rj  £  Q. 

The  significance  of  associating  the  Lie  algebra  Q  with  the  Lie  group  G  comes 
about  when  G  is  connected  (as  a  topological  manifold).  In  this  case,  many 
group-theoretic  properties  of  G  can  be  expressed  as  algebraic  properties  of  Q.  For 
example,  we  define  CG,  the  center  ofG,  and  Cg,  the  center  of  Q,  as 

CG  =  {h  |  gh  =  hg,  V</  €  G},  CQ  =  {q  |  [£,  rj\  =  0,  €  Q}. 
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Then  we  say  that  the  group  G  is  abelian  if  Cg  =  G ,  and  the  Lie  algebra  is  abelian 
if  Cg  =  Q.  One  can  show  that  G  is  an  abelian  group  only  if  Q  is  an  abelian  Lie 
algebra.  Thus,  checking  to  see  if  G  is  abelian  is  easy  since  checking  that  Q  is 
abelian  amounts  to  showing  that  [£,  rj\  =  0  holds  for  £,  rj  G  {£1, . . . , ,  £„},  a  basis 
for  Q. 

We  define  other  important  properties  of  Lie  algebras  and  Lie  groups  as  follows. 
Let  Q,  V,  be  Lie  algebras.  Denote 

[S,«]  =  {[?,<)]  If  eS, >)€«}. 

A  subspace  H  C  Q  is  called  an  ideal  if  [Q,H]  C  %.  We  define  the  derived  series 
of  Q  to  be 

Q  2  O'  =  [G,  G]  2  G"  =  \G\  G'}2---2  G{k)  =  [G{k~l\  ^(fc_1)]  5  . . . 

and  the  lower  central  series  of  Q  to  be 

G2G2  -G'  -  [G,G]  2G3  =  [G2,G]  2---2Gk  =  [  Gk~\G]  2-.. 

Then  we  say  that  Q  is  solvable  if  Q ^  =  0  for  some  positive  integer  k.  We  say 
that  Q  is  nilpotent  if  Qk  =  0  for  some  positive  integer  k.  The  smallest  integer 
l  such  that  Ql+l  =  0  is  called  the  order  of  nilpotency.  A  Lie  algebra  Q  is  said 
to  be  simple  if  it  is  non-abelian  and  has  no  ideals  other  than  0  and  Q.  It  is 
semi-simple  if  it  is  non-abelian  and  has  no  abelian  ideals  other  than  0.  A  Lie 
group  G  is  simple  (resp.  semi-simple)  if  its  associated  Lie  algebra  is  simple  (resp. 
semi-simple) .  Simplicity  implies  semi-simplicity. 
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2.1.2  Control  Systems  on  Lie  Groups 

We  define  a  control  system  on  the  n-dimensional  Lie  group  G  as 

m 

9  =  Yo(g)  +  '52ui(t)Yi(g),  g(t)  G  G,  u{(t)  G  3ft,  m  <  n,  (2.5) 

i—\ 

where  Y0, . . .  ,Ym  are  vector  fields  on  G  and  u  =  (u\, . . . ,  um)  are  interpreted  as 
the  control  inputs.  If  Y0,...,Ym  are  left-invariant  (resp.  right-invariant)  on  G 
then  we  say  that  (2.5)  is  a  left-invariant  (resp.  right-invariant)  control  system  on 
G.  If  (2.5)  is  left-invariant  we  can  express  it  as 

m 

g  =  TeLg(f o  +  ]T  itj(t)&),  g(t)  G  G,  Ui(t)  G  9?,  m  <  n,  (2.6) 

i=i 

for  some  fixed  £o>£i)---)£m  G  Q.  Similarly,  if  (2.5)  is  right-invariant  it  can  be 
written  as 

m 

g  =  TeRg{€a  +  J2ui(t)ti),  g{t)  e  G,  Ui(t)  e  m  <  n,  (2.7) 

i=  1 

for  some  fixed  £0,  £i,  •  •  • ,  €  Q.  The  term  TeLg  ■  £0  in  (2.6)  (similarly  TeRg  ■  £0 

in  (2.7))  is  called  the  drift  term  since  g  drifts  as  g  =  TeLg  •  £0  if  it  =  0.  Thus, 
system  (2.6)  (similarly,  (2.7))  is  called  drift-free  if  the  drift  term  is  zero. 

In  this  dissertation  we  focus  on  left-invariant  systems  on  Lie  groups,  but  we 
note  that  analogous  results  can  be  derived  for  right-invariant  systems.  In  fact, 
given  a  right-invariant  system  (2.7),  we  can  always  convert  it  into  a  left-invariant 
system  by  considering  g~l{t )  as  our  state  trajectory.  Let  g(t)  G  G  satisfy  (2.7) 
and  define  £(t)  =  £o  +  ££Li  «j(t)£j.  Since  jt{g{t)g~l(t ))  =  ^(e)  =  0,  we  have  that 

0  =  S(s9"‘)  =  + 

=  {TgRg- 05  +  (Tg-iLg)^-1) 
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(2.8) 


=  (T,R,-,)(T'R,)((  t)  4-  (T,-,Lg)~(g-') 

=  f(t)  +  (T^.L,)|  (g-1). 

This  implies  p_1(t)  satisfies 

jt(g-')  =  T'Lr>(-m 

which  is  a  left-invariant  system  on  G.  Thus,  there  is  no  loss  of  generality  in 
specializing  to  left-invariant  systems. 

2.1.3  Problem  Statement  on  Lie  Groups 

The  systems  of  interest  in  this  dissertation  take  the  form 

m 

g  =  eTeLg -U(t),  tf(f)  =  £  «,(*)&  m<n,  (2.9) 

»= l 

where  g(t)  is  a  curve  in  the  n-dimensional  Lie  group  G  and  U(t)  is  a  curve  in  the 
Lie  algebra  Q  associated  with  G.  Here  £l  , . .  • ,  are  fixed,  linearly  independent 
elements  of  Q  which  can  be  completed  such  that  {£i, . . .  ,£n}  is  a  basis  for  Q. 
The  U{(t )  are  scalars  meant  to  represent  control  inputs.  We  will  assume  that 
the  Ui(t),  i  =  1 , ,m  are  periodic  in  t  of  common  period  T.  The  factor  e  is  a 
small  parameter  representing  the  small  amplitude  of  the  control  inputs.  That  is, 
eui(t), . . . ,  eum(t)  are  our  small-amplitude,  periodic  controls.  We  will  sometimes 
extend  the  vector  of  control  components  to  be  of  length  n  by  writing  u(t)  = 
(ui(t), . . . ,  un(t ))  where  we  set  um+\  =  ...  —  un  —  0.  Since  0  is  trivially  periodic 
in  t  of  any  period  T,  then  the  extended  vector  u(t)  is  still  periodic  in  t  of  period 
T. 

We  note  that  (2.9)  as  described  is  a  drift-free  system.  However,  if  at  least 
one  of  the  components  Ui  is  not  an  adjustable  control  then  (2.9)  is  a  system  with 
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drift.  The  averaging  theory  of  Chapter  4  does  not  depend  on  the  system  being 
drift-free,  only  on  the  curve  U(t)  being  periodic  in  t  of  common  period  T.  In 
Chapter  6  we  address  a  motion  control  problem  for  a  system  with  drift. 

We  also  note  that  (2.9)  is  left-invariant.  One  important  implication  of  left- 
invariance  is  that  the  solution  g(t)  to  (2.9)  with  any  initial  condition  <?(0)  =  g0 
can  be  expressed  as  g(t)  =  goge(t )  where  ge(t)  is  the  solution  to  (2.9)  with  initial 
condition  ge(0)  =  e  €  G.  The  right-invariant  analogue  to  (2.9)  is  given  by 

m 

g  =  eTeRg  ■  U(t),  U(t)  =  ^wi(t)£i,  m<n.  (2.10) 

i= 1 

The  solution  g(t)  to  (2.10)  with  initial  condition  g(0)  =  g0  E  G  is  g(t)  =  ge(t)go 
where  ge(t )  is  the  solution  to  (2.10)  with  ge(0)  =  e  G  G. 

The  constructive  controllability  problem  for  system  (2.9)  (or  (2.10))  can  be 
stated  formally  as 

(P)  Given  an  initial  condition  ft?G,a  final  condition  gj  G  G  and  a  time  tf  >  0, 
find  u(t)  =  (ui(t), . . .  ,um(t)),  t  €  such  that  g( 0)  =  gi  and  g(tf)  =  gf. 

2.1.4  Control  Systems  on  Matrix  Lie  groups 

Matrix  Lie  groups  are  Lie  groups  with  matrix  elements.  They  are  an  important 
special  class  for  our  purposes  since  they  are  the  Lie  groups  of  interest  for  all  of  the 
applications  in  this  dissertation.  Every  matrix  Lie  group  over  Sift  is  a  subgroup 
of  the  general  linear  matrix  Lie  group  GL(n)  (for  some  n)  which  is  the  space 
ofnxn  nonsingular  matrices,  under  matrix  multiplication.  Examples  of  other 
matrix  Lie  groups  include 
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SL(n) 
0(n ) 
SO{n) 


SE(n) 


Unipotent  group 


{X  £  GL(n)  |  detX  =  1} 
{X  £  GL(n)  |  XTX  =  1} 


{X  £  GL(n)  |  X  £  O(n)  n  5L(n)} 


l 


A  b 
0  1 


\ 


£  GL(n  +  1)  |  A  £  SO(n),  6  £  3£n} 


{X  —  [Xy]  £  GL{n)  |  Xu  —  1,  Xij  =  0  if  i  >  j }. 


SL(n)  is  called  the  special  linear  group ,  0(n)  the  orthogonal  group,  SO(n)  the 
special  orthogonal  group,  and  SE(n)  the  special  Euclidean  group. 

The  Lie  algebra  gl(n )  associated  with  GL(n )  is  the  space  of  all  n  x  n  matrices 
with  the  Lie  bracket  operator  defined  as  the  matrix  commutator,  i.e. , 


[A,  B]  =  AB  -  BA,  VX,  B  £  gl{n). 


The  Lie  algebras  of  other  matrix  Lie  groups  are  subspaces  of  gl(n)  with  the  same 
Lie  bracket  operation.  For  example, 


sl(n ) 


=  {A  G  gl(n)  |  tr(A)  =  0} 


so(n) 


se(n) 


=  {A  G  gl(n)  |  AT  +  A  =  0} 


x 


1 G  gl(n  +  1)  |  A  G  so(n ),  x  G  3?”} 


V°  °J 


Lie  algebra  of  unipotent  group  =  {A  =  [Aij]  £  gl(n)  \  Aij  =  0  if  i  >  j}. 


Here,  the  name  of  the  Lie  algebra  is  the  same  as  the  associated  group  but  in 
lower-case  letters.  Since  SO{n )  is  the  connected  component  of  0(n)  containing 
the  identity,  so(n)  is  the  Lie  algebra  associated  to  both  SO(n)  and  0(n).  We 
note  that  SL(k),  0(n),  SO(n )  are  simple  Lie  groups  (for  k  >  1,  n  >  2)  since 
their  associated  Lie  algebras  are  simple.  Also,  se(2)  is  a  solvable  Lie  algebra,  and 
the  Lie  algebras  of  unipotent  groups  are  all  nilpotent. 
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Left-invariant  (resp.  right-invariant)  vector  fields  on  a  matrix  Lie  group  G 
take  the  form  XA  (resp.  AX)  with  X  6  G  and  A  E  Q,  where  Q  is  the  associated 
matrix  Lie  algebra.  The  exponential  map  from  matrix  Lie  algebras  to  matrix  Lie 
groups  is  equivalent  to  the  matrix  exponential  defined  as  exp(A)  =  ~A{, 

A  E  Q.  The  left-invariant  control  system  described  by  (2.9)  specialized  to  matrix 
Lie  groups  becomes 

m 

X  =  eXU(t),  U(t )  =  y) Uj(t)Aj ,  m<n,  (2-11) 

i= 1 

where  X  ( t )  is  a  curve  in  the  n-dimensional  Lie  group  G  and  U  ( t )  is  a  curve  in  the 
Lie  algebra  Q  associated  with  G.  A\, . . .  ,Am  are  constant  matrices  in  Q  which 
we  can  complete  as  {A\, . . .  ,An)  to  be  a  basis  for  Q.  The  terms  Ui(t)  and  the 
parameter  e  are  as  defined  for  (2.9). 


2.2  Controllability  and  Geometry 

In  this  section  we  review  basic  definitions  and  theorems  on  nonlinear  control¬ 
lability  with  application  to  systems  on  Lie  groups.  We  then  define  geometric 
quantities  that  are  the  essential  elements  of  the  basis-independent,  average  mo¬ 
tion  control  solutions  derived  in  later  chapters. 

2.2.1  Controllability 

We  review  controllability  theory  for  left-invariant  control  systems  on  Lie  groups 
defined  by  equations  (2.6),  based  on  [11,  29],  Although  these  papers  deal  with 
with  right-invariant  systems,  by  the  argument  of  Section  2.1.2,  we  can  derive 
analogous  results  for  left-invariant  systems.  Let  G  be  the  system  group  and  let 
Q  be  its  associated  Lie  algebra.  As  will  shown  below,  it  is  the  space  spanned 
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by  the  system  vector  fields  and  their  Lie  brackets  that  play  a  critical  role  in  the 
determination  of  controllability. 

Following  Jurdjevic  and  Sussmann  [29],  we  make  the  following  definitions.  U 
is  the  class  of  admissible  controls  where  U  is  either  Uu,  Ur  or  Ub  and 

(i)  Uu  is  the  class  of  locally  bounded,  measurable  functions  on  [0,  oo)  taking 

values  in 

(ii)  Ur  C  Uu  with  elements  taking  values  in  the  unit  n-dimensional  cube. 

(iii)  Ub  is  the  class  of  piecewise  constant  functions  on  [0,  oo)  taking  values  in 
where  components  of  its  elements  take  values  in  the  set  {—1,1}. 

If  u  £  U  and  g0  £  G,  we  denote  the  solution  g  of  (2.6)  which  satisfies  #(0)  =  g0 
by  n(gQ,  u ,  •),  i  e.,  g(t)  =  n(g0,  u,  t),  Vf  e  [0,  oo).  If  7c(g0,  u,  t )  =  gi  for  some  t  >  0 
then  we  say  u  steers  g0  into  <71  in  t  units  of  time.  System  (2.6)  is  said  to  be 
controllable  if  there  exists  an  admissible  control  u  e  U  that  steers  any  go  G  G 
into  any  gi  6  G,  with  no  constraints  on  how  many  units  of  time  are  required. 
Let  C  denote  the  set  of  Lie  brackets  generated  by  {£1, . . .  ,£m}  defined  as 

C  =  {n\v  =  [*, fat-i, [■••, hi, i)o] ■"]]]>  e  {fi.- ••.{«.},  j  = 

(2.12) 

Similarly,  let  C0  denote  the  set  of  Lie  brackets  generated  by  {£o>  •  •  •  >£m}>  i-e-> 

Co  =  {v  I  v  =  W, te-i, (■  ■  ■ , hi,i?o] ■  ■  HI,  m  e 

(2,13) 

We  say  that  span(C)  (resp.  span(C0))  is  the  Lie  algebra  generated  by  {£1, . . . ,  £m} 
(resp.  {£0, . . .  ,£m}).  We  first  give  the  controllability  condition  for  drift-free  sys¬ 
tems.  We  refer  to  this  condition  as  the  Lie  algebra  controllability  rank  condition. 
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Theorem  2.1  (Jurdjevic  and  Sussmann)  Let  (2.6)  be  a  drift-free  system  on 
G ,  a  connected  Lie  group.  Then  (2.6)  is  controllable  with  u  G  U  if  and  only  if 
span(C)  =  Q.  HU  —  Uu  then  the  system  is  controllable  in  arbitrarily  short  time. 

There  is  a  similar  condition  for  systems  with  drift  on  compact  Lie  groups. 

Theorem  2.2  (Jurdjevic  and  Sussmann)  Let  (2.6)  be  a  system  with  drift  on 
G,  a  compact  and  connected  Lie  group.  Then  (2.6)  is  controllable  with  u  G  U  if 
and  only  if  span(C0)  =  Q.  Further,  3 1'  >  0  such  that  for  every  g$,gi  £  G  there 
is  a  control  u  GU  that  steers  g0  into  g\  in  less  than  t'  units  of  time.  If,  further, 
G  is  semi-simple,  then  3 t'  >  0  such  that  for  every  £  G  there  is  a  control 
u  Gli  that  steers  g0  into  g\  in  exactly  t'  units  of  time. 

We  next  make  definitions  to  further  characterize  the  controllability  of  system 
(2.6).  Here,  we  assume  that  the  system  is  drift-free,  i.e.,  that  £o  =  0.  We  define  a 
depth-p  Lie  bracket  on  Q  as  p  iterated  brackets,  e.g.,  [ry^,  [ry^-i,  [■  •  • ,  [rji,  rj 0]  •  •  ■]]]. 
A  depth-zero  bracket  is  just  an  element  of  the  Lie  algebra  Q.  We  often  refer  to  a 
depth-one  bracket  as  a  single  bracket,  a  depth-two  bracket  as  a  double  bracket,  etc. 
If  j  is  the  minimum  positive  integer  such  that  the  Lie  algebra  controllability  rank 
condition  is  satisfied  with  C  containing  only  up  to  depth-j  brackets,  i.e.,  k  <  j 
in  (2.12),  then  we  say  that  system  (2.6)  is  a  depth-j  bracket  system.  We  refer  to 
a  depth-one  bracket  system  as  a  single-bracket  system,  a  depth-two  bracket  as  a 
double-bracket  system,  etc. 

Following  [23,  60]  we  define  the  growth  vector  and  relative  growth  vector.  Let 

Di  =  span{£l5 . . .  ,£m}, 

Di  =  Dj_i  +  span[£>i,  A-i], 
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The  growth  vector  for  a  depth-(p  —  1)  system  is  defined  as 

r  =  (ri, ...  ,rp)  £  Zp ,  where  ri  =  dimDj. 

The  relative  growth  vector  is  defined  as 

a  =  (<7i, . . . ,  ap)  £  Zp,  where  ol-ri-  r^u  r0  =  0.  (2.14) 

Thus,  for  a  single- bracket  system,  r  =  (m,  n),  a  =  (m,  n  —  m).  For  a  double¬ 
bracket  system,  we  define  0  <  l  <  (n  —  m)  such  that  r  =  ( m,m  +  l,n),  a  = 
( m ,  /,  n  —  (m  +  /)). 

2.2.2  Geometry 

Given  a  basis  {£i, . . . ,  £n}  for  a  Lie  algebra  Q ,  one  computes  the  associated  struc¬ 
ture  constants  as 

*J 

[«(.&]  =  i,j  =  (2.15) 

k= 1 

We  define  the  depth-two  structure  constants  % 1*  associated  with  basis  {£i, . . . ,  £n} 
by 

=  P-ie) 

i=l 

This  definition  comes  from  the  computation  of  structure  constants  for  depth-two 
Lie  brackets  as  follows: 

(Ki.  a  61  =  E  r‘,6,  &]  =  £  rjjis,  6b]  =  ££  r'yrft&  =  £ 

1=1  1=1  p=  1  (=1  p=  1 

Skew  symmetry  of  the  Lie  bracket  on  Q  and  the  Jacobi  identity  imply 

r‘=-r‘„  e%t  =  -erjit,  +  <&  +  =  o.  (2.17) 
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Higher-order  structure  constants  can  similarly  be  defined.  Let  IP  be  the  ordered 
list  of  indices  Ip  =  {*i,  i2>  •  •  •  >  *p}  where  iv  £  {1, . . . ,  n},  v  =  1, . . .  ,p.  Then  we 
define  the  depth-(p  —  1)  structure  constants  T*  as 

=  (2.18) 

fc=l 

Note  that  e\jk  =  rj;,. 

We  make  the  following  definitions  given  that  u  =  (ui, . . . ,  um )  is  periodic  in  t 
of  common  period  T.  Let  the  time  average  of  u  be  uav  =  (uavi, . . . ,  uavm)T  where 

1  rT 

Uavi  =  TP  /  Ui(r)d,T,  (2.19) 

1  Jo 

and  let  the  time  integral  of  u  be  u  =  (ui, . . . ,  um)T  where 

Ui(t)  =  f  Ui(r)dT.  (2.20) 

Jo 

So  u  =  u.  If  uav  =  0  then  u  is  periodic  in  t  with  common  period  T.  We  also  let 

m  m 

Uav  =  T/U^i,  U  =  J2Ui-  (2.21) 

1=1  i=l 

We  next  define  area  and  moment  terms  that  are  fundamental  to  our  average 
solution  formulas  of  Chapter  4.  Define 

1  [T  .  ,  •  /  s 

Areaij(T)  =  -  /  (ui(a)v,j(a)  —  Uj(a)v,i(a))da.  (2.22) 

Z  JO 

If  uav  =  0,  then  by  Green’s  Theorem,  Areaij(T )  is  the  area  bounded  by  the  closed 
curve  described  by  and  Uj  over  one  period,  i.e.,  from  t  =  0  to  t  =  T.  This  area 
can  be  interpreted  as  the  projection  onto  the  i-j  plane  of  the  area  enclosed  by 
the  curve  («i, . . . ,  um )  in  one  period.  If  uavi  ±  0  and/or  uaVj  ^  0  then  Areaij(T) 
can  be  interpreted  as  the  area  bounded  by  the  curve  described  by  Ui  and  Uj  and 
the  straight  line  described  by  uavit  and  uaVjt  over  one  period.  Define 

1  A  ■ 

aij(t)  =  2  JQ  (ui(a)uj(a)  -  Uj(a)ui(o))da.  (2.23) 
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For  uav  =  0,  )  is  of  the  form 


aij(t)  =  | ;AreOij(T )  +  f{t),  (2.24) 

where  f(t  +  T)  =  f(t),  /( 0)  =  0.  So,  in  particular, 

ay(MT)  =  MAreaijiT)  (2.25) 


where  M  is  a  positive  integer.  Let 


1  fT 

mijk(T)  =  -  y  (Ui(a)uj(a)  -  tti(a)tti((r))ufc(a)d(j. 


(2.26) 


Assume  uav  =  0  and  consider  the  closed  curve  C  defined  by  Uj(t)  and  uk(t) 
over  one  period,  i.e.,  from  t  =  0  to  t  =  T.  From  (2.26)  we  get  that 


mijk(T)  =  \  UiUkdv,j  -  UjUkdui. 

o  JC 


Let  A  be  any  oriented  surface  with  boundary  dA  =  C.  Then  by  Stokes’  Theorem, 


m>ijk(T)  —  -  [  —Uidujduk  —  Ujdukdui  +  2ukdutduj .  (2.27) 

3  J  A 


So  rriijk(T)  as  described  by  (2.27)  can  be  interpreted  as  a  first  moment,  i.e.,  a 
linear  combination  of  Ui  integrated  over  the  area  of  the  projection  of  A  onto  the 
j-k  plane,  Uj  integrated  over  the  area  of  the  projection  of  A  onto  the  k-i  plane 
and  uk  integrated  over  the  area  of  the  projection  of  A  onto  the  i-j  plane.  We 
have  the  following  (skew-symmetric  and  Jacobi-like)  identities: 


Areaij(T)  =  -Area^(T),  a,ij(t)  =  —a,ji(t),  (2.28) 


mijk(T)  =  -mjik(T),  mijk(T )  +  mjki(T)  +  mkij{T)  =  0.  (2.29) 
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2.3  Local  Solutions 


Since,  in  general,  there  are  no  explicit  global  representations  of  the  solution  to 
(2.9)  we  make  use  of  local  representations:  the  product  of  exponentials  represen¬ 
tation  given  by  Wei  and  Norman  [77]  and  the  single  exponential  representation 
given  by  Magnus  [54]  and  Fomenko  and  Chakon  [21]. 

2.3.1  Product  of  Exponentials 

We  begin  by  defining  the  product  of  exponentials  representation  which  is  given 
by  Wei  and  Norman  [77].  They  state  their  result  for  right-invariant  systems  on 
matrix  Lie  groups,  but  we  prove  the  more  general  result  for  a  left-invariant  system 
of  the  form  (2.9)  on  a  finite-dimensional  abstract  Lie  group  G  with  Lie  algebra  Q. 
We  use  the  extended  control  vector  u  —  (u1} . . . ,  un)T  where  um+1  =  . . .  =  un  =  0. 

Lemma  2.3  (Wei  and  Norman)  Let  g(t)  be  the  solution  to  (2.9)  with  #(0)= 
e  G  G.  Then  3t0  >  0  such  that  for  |i|  <  t0,  g(t)  can  be  expressed  in  the  form 

g(t)  =  e7,(t)f*  =  e7l(t)?1e72We2  •  •  •  e7n(t)fn  .  (2.30) 

i=  1 

The  Wei-Norman  parameters  7  =  (71, ... ,  7„)r  satisfy 

7  =  eM{^)u  ,  for  ]f|  <  t0  ,  (2.31) 

where  e7t?1  =  exp(7i£;)  is  the  exponential  map  defined  by  (2.1),  7(0)  =  0  and 
M( 7)  is  a  real-analytic,  matrix-valued  function  of  7.  If  Q  is  solvable  then  there 
exists  a  basis  of  Q  and  an  ordering  of  this  basis  for  which  (2.31)  holds  globally, 
i.e.,  for  all  t,  and  in  that  case  (2.31)  can  be  integrated  by  quadrature. 

Proof.  Let  g(t)  satisfy  (2.30).  Then 

n  <9 

9  —  y  '  ^7)  (^e7 1^1  Re~ln(n  P-e~li+lU+l  (c7’^1  )) 

1=1  a1i 
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d 

=  iiTgliU  {Leiii I  •  *  •  Le'ti_1Zi_l  Rtfnin  *  •  •  -Rg7i+l$i+l  ) 


i= 1 
n 


—  'yi'I'ehtt  {LgL  e~1  ntn  ‘  ‘  •  Lg-ij^Rg-yntn  •  •  •  i?e7i+l$i+l  )TeL 

e'i'iSi  *  £z 

i=l 

n 

=  /yi{'I'eLg)Te'riti  (Le-7ntn  '  •  *  L^iuRemtn  •  *  *  -Rg'Yi+l^i+l  )TeLe'yiZi  * 

z=l 

n 

=  T^e^g  ^  ^  'JiTtfitj  [Re*1nZnLe-lnZn  *  *  *  ■RgYt+lft+l  -^e_7i+l£t+l  ^eT^iU  )^e-^e7»£*  *  ^ 
i=l 
n 

~  TeLg  Y.liTe{Re,nZnLe-,nin  *  '  *  -R^i+l^i+l  -^'e_7*+1^+1  )  (^e7*^*  ) -^e-^e7»*»  '  £z 

Z=1 

n 

=  TeLg  y  ^  7tTe(i2e7n€n  Le-inin  )  Te(i?e7i+i$i+i  -£^-7*+ l£i+l  )  ’  £z 

i=l 
n 

=  TeL,  ^  ]  7z^de-7n^n  (Ade-7n_1€n_1  (*  *  *  (Ade-7i+1£i+1  £*))) 

Z=1 

=  TeL,  J^e-**1*  (e-^-iad<n-i  (•  •  •  (e-7i+iad«i+1^.))))  (2.32) 

2=1 

where 

e“Tiad'<«,  =  E  h-7f)'< 6  e  e.  (2.33) 

z=o  L 

Premultiplying  both  (2.32)  and  (2.9)  by  (TeLs)_1  and  equating  gives 

5^  7ie_7"ad«"  (e_7"-iad«"-i  (•  •  •  (e_7»+iad?j+1^)))  _  eUi&. 
i=l  i=l 

By  (2.33)  and  following  [77]  we  can  define  0:^(7)  analytic  in  7  as 


e  7nad$n  (. . .  (e  7i+iadtJ+1^jj  _  ^  ay  (7)6 

2  =  1 


(2.34) 


such  that 


n  n 


Z  7j  Z  “0(7)6  =  E 


j=l  1=1  i=l 

Since  the  &’s  are  linearly  independent,  we  equate  coefficients  of  & 

M(y)7  = 

(  \ 
Oi  11  a12  •  •  •  Oil  n 

(  ■  \ 
7i 

— 

(  \ 
eu  1 

^  CTil  .  .  .  Oinn  j 

V  "in  ) 

y  CUn  y 
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At  t  =  0,  7(0)  =  0  and  so  M( 0)  =  I.  Thus,  there  exists  a  neighborhood  N0  of  t  = 
0  such  that  M(^(t))  is  nonsingular  Vf  €  Nq.  We  define  M( 7)  =  M~1( 7),  Vt  6  iVo 
and  the  first  part  of  the  lemma  follows.  If  Q  is  solvable,  then  it  can  be  shown  that 
for  a  suitable  choice  of  basis,  M( 7)  is  lower  triangular  and  the  above  differential 
equations  are  integrable  by  quadrature.  1=1 


Remark  2.4  From  this  proof  we  observe  that  we  can  express  M( 7)  in  terms  of 
the  structure  constants  associated  to  (£1, . . . ,  £n)  defined  by  (2.15).  By  (2.33)  and 
(2.34) 

e-7"ad^"  (•  •  •  (e  ^^^dq+i^)) 

=  (/  -  7nad?n  +  ...)(/-  7„_1adfn_1  +  ...)•••(/-  7i+iadfi+1  +  . .  .)£,- 


i=i 


=  (7~  E  7fead4 +0(72))£j 
A:=j'+1 

=  Zj-  it  7*[&»&]  +  0(7*) 
fc=j+i 

=  (j-E(E  7*7,06 +o< 72) 

*=1  fc=i+i 

where  0(72)  is  quadratic  or  higher  order  in  the  components  of  7.  So 

-  Ek-1+1 7*7,  +  0(72),  >  /  ] 

i-n=,+17*7j  +  0(72).  «  =  J. 

Thus,  M(7)  —  I  —  a( 7)  4-  0(72)  where  the  ijth  element  of  <5  is 


«ii(7)  =  S 


Q! 


O 


(7)  =  E  7*1*,-. 

fc=j+i 


Since  M(7)  =  M  *(7),  we  have  that  (for  ||7||  small) 

M(  7)  =  /  +  <5(7)  +  0(72). 


(2.35) 


(2.36) 


We  use  this  observation  in  Chapter  4. 
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It  is  customary  to  refer  to  components  of  7  as  the  canonical  coordinates  of 
the  second  kind  for  G.  Let  W  be  the  open  neighborhood  of  0  €  such  that 
V7  G  W,  M (7)  is  well-defined.  Let  Pr:  3?"  -»  G  define  the  mapping 

Pr(7)  =  e7lfle7a6  •  •  •  e7"^  (2.37) 

and  define  V  =  Pr(IT)  C  G.  Then,  the  Wei-Norman  formulation  provides  a 
local  representation  of  the  solution  to  (2.9)  for  initial  condition  g(0)  G  V  C  G. 
Now  let  S  be  the  largest  neighborhood  of  0  G  9?n  contained  in  W  such  that 
’F  =  Pr|s  :  S  — >  G  is  injective.  Let  Q  =  4/( S )  C  V.  Then  'L  :  S  — >  Q  is  a 
diffeomorphism  and  we  can  define  a  metric  d  :  Q  x  Q  — v  by 

d(X,  Y)  =  y~\Y))  (2.38) 

where  for  |j  •  ||,  a  norm  on  3in,  d  :  3f?n  x  3Jn  — y  is  given  by 

d(a,f3)  =  \\a-(3\\.  (2.39) 

2.3.2  Single  Exponential 

The  solution  to  (2.9)  with  <?(0)  =  e  can  also  be  represented  locally  as  a  single 
exponential, 

g(t)  =  em  =  exp g(t)  G  G,  Z(t)  G  Q.  (2.40) 

This  is  irrespective  of  e  in  (2.9)  being  a  small  parameter.  However,  we  include  e  in 
the  expressions  below  since  we  will  need  it  in  later  chapters.  Feynman  represented 
the  solution  (2.40)  symbolically  as  Exp  Jq  eU(r)dr  (sometimes  referred  to  as  a  T- 
product  of  exponents )  and  derived  a  formula  for  it  in  terms  of  a  certain  formal 
series  [20].  Z(t)  is  sometimes  referred  to  as  the  logarithm  of  a  multiplicative 
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integral,  represented  symbolically  as  Z(t)  =  In  nt=o  eeU^dT .  Magnus  showed  for 
(2.10)  (the  right-invariant  analogue  of  (2.9))  that  Z(t)  locally  satisfies 

^  =  <p(ad  m)(eU(t)),  Z(  0)  =  0,  (2.41) 

where  cp(x)  —  x/{ex  —  1)  [54].  Further,  Magnus  illustrated  that  (2.41)  can  be 
integrated  by  iteration  to  yield  an  expression  for  Z(t)  as  an  infinite  series  of 
iterated  integrals.  This  formula  is  the  continuous  analogue  of  the  Campbell- 
Baker-Hausdorff  formula  which  gives  the  solution  to  C  where  ec  —  eAeB  and  A 
and  B  are  noncommuting  elements  of  a  Lie  algebra  (close  enough  to  0).  Magnus 
did  not  provide  general  convergence  criteria  for  his  infinite  series  solution. 


Karasev  and  Mosolova  addressed  the  problem  of  convergence  criteria  and, 
using  the  theory  of  ordered  operators,  derived  an  explicit  expression  for  Z(t)  for 
the  right-invariant  system  (2.10)  [31].  The  norm  ||  •  ||  on  Q  in  their  work  (and  in 
the  work  of  Fomenko  and  Chakon  that  follows)  is  assumed  to  be  one  that  makes 
Q  a  Banach  algebra.  So  for  matrix  Lie  algebras,  ||  ■  ||  is  the  vector  space  norm.  Let 
(j){x)  =  \ax/{x  —  1)  and  r  =  exp(/g  ||ad££/(T)||dr).  Consider  the  extended  control 
vector  u  =  (wi, . . . ,  un)T  where  um+ 1  =  ...  =  «„  =  0. 


Theorem  2.5  (Karasev  and  Mosolova)  If  r  <  2  then  for  eU ( t )  =  e  £”=iUj(f)&, 

Exp  /  eUMdr  =  ez^\ 

Jo 

where  Z(t)  is  an  element  in  the  Lie  algebra  generated  by  {£i, . . .  ,£m}.  Z(t)  is 
given  by 


Z(t)  =  J  0(Exp  J  &deu{<T)da)eU (t)cIi 


and  satisfies 


\Z{t)\\  < 


1 

r  —  1 
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For  G  a  finite-dimensional  Lie  group,  the  convergence  criterion  r  <  2  is  equiv¬ 
alent  to 

f  ||A(c«(r))||dr  <  ln2,  (2.42) 

Jo 

where  A(-)  is  an  n  x  n  matrix  with  ij th  element  A,j(-)  defined  by 

Aj  j(u)  =  ^  uk^kj- 
k= 1 

In  the  case  that  (7  =  50(3)  and  {Ai,  A2,  A3}  (defined  in  Section  3.1)  is  the 
standard  basis  for  Q  =  so(3),  it  is  easy  to  compute  that  A (eu)  —  dJ  and  so  (2.42) 
is  equivalent  to 

[  ||e£/(r)||dr  <  In 2. 

Jo 

More  recently,  Fomenko  and  Chakon  studied  the  problem  of  representing  Z  ( t ) 
as  a  convergent  series  Z(t )  =  [21].  They  derived  explicit  recursion  re¬ 

lations  satisfied  by  the  terms  Z*.  The  following  theorem  states  their  results 
(in  part)  for  the  right-invariant  system  (2.10).  The  theorem  uses  the  universal 
constant  b  defined  as  follows.  Let  h(x)  be  the  solution  of  the  scalar  equation 
dh/dx  =  ex(q(h)  +  h/2)  with  h( 0)  =  0  and  with  q{h)  =  1  +  |fc2p|A2p.  Here, 
k2p  ■  (2p)!  =  fJ2p  and  fJ2p  are  Bernoulli  numbers  given  by 

x 

ex  — 

For  example,  (5q  =  1,  /?i  =  —1/2,  j32  =  1/6,  fa  =  —1/30, _  The  universal 

constant  b  <  2-k  is  defined  such  that  h(x)  is  analytic  on  a  disc  |rr|  <  b. 

Theorem  2.6  (Fomenko  and  Chakon)  Let  8  =  b/M,  where  M  >  1  is  a  con¬ 
stant  such  that  |! [77,  C]||  <  M||p||||C||,  Vr/,C  6  Q.  Suppose  that  U(t)  is  a  piecewise 
continuous  curve  in  Q  and  //  \\eU{r)\\dT  <  5.  Then  Z(t)  =  Y,iL\dLZi(t)  is  a 
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convergent  series.  The  terms  Zi(t)  are  uniquely  defined  by 


Zi(t)  =  T0(t) 

=  [  U{r)d,T , 

Jo 

(i  +  l)Z.+i(i) 

=  Ti  +  't{\{z„'ri-A 

r=l  ^ 

(2.43) 

+  53  ^2p  53  [Zmi ,  [Zm2 ,  ■  •  •  ,  [Zm2p ,  Tj_r] 

•••]}, 

P>l,2p<r 

T,(t) 

=  j0^U^Tl^J0  [^(T2  )>-”>jf  U(Tk+i)dTk+i]dTk]. 

..}dri. 

We  note  that  each  term  Zl  is  composed  of  depth- {%  —  1)  brackets.  The  expres¬ 
sion  for  Z(t)  as  the  logarithm  of  the  solution  to  the  left-invariant  system  (2.9) 
can  be  computed  directly  from  the  results  of  Theorem  2.6. 

Corollary  2.7  Consider  the  left-invariant  system  (2.9)  with  #(0)  =  e.  For  the 
same  assumptions  on  U(t)  as  in  Theorem  2.6,  g(t )  —  ez^\  Z(t)  €  Q  and 

OO 

m  =  £(-l)i+VZi(t),  (2.44) 

2=1 

where  Zi(t)  are  defined  by  (2.43). 


Proof.  By  (2.8)  of  Section  2.1.2,  (2.9)  is  equivalent  to 


By  Theorem  2.6  g  1(t)  =  eY^\  Y(t)  =  clFi(t)  where 


m  = 


- Zi(t ) 


i  is  odd 


|  Zi(t )  i  is  even 

This  follows  since  Zi(—U(t))  =  —Zi(U(t)),  for  i  odd  and  Zj(— U(t))  =  Zi(U(t )) 
for  i  even.  Thus,  g(t)  =  e~Y ®  and  the  corollary  follows.  a 
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We  show  the  first  few  terms  of  the  series: 


Zi(t)  =  U(t) 

Z2(i)  =  \  [\V(t)Mt)W  (2.45) 

Z’,(<)  =  \j0[U(T),  jo\U(a),U(a)}da]dT  +  ^\U(i),  l^\U(T),U(T)]dT\. 

Since  Z(t )  £  Q  we  can  write  Z(t)  =  ^£=1  Zk(t)£k  where  (£1, . . .  ,£n)  is  a  basis 
for  Q.  (zi, . . . ,  2(„)  are  referred  to  as  canonical  coordinates  of  the  first  kind  for  G. 
Let  S  be  the  largest  neighborhood  of  0  £  Q  such  that  'fr  =  exp  :  S  — t  G  is 
injective.  Let  Q  =  ^(<5)  C  G.  Then  ^  :  S  -4  Q  is  a  diffeomorphism  and  we  can 
define  a  metric  d  :  Q  x  Q  — >  by 

d(X,  Y)  =  4'-1(^))  (2.46) 

where  d  is  given  by  (2.39). 

Lazard  and  Tits  showed  for  a  class  of  Lie  groups  that  the  exp  map  is  injective 
on  a  reasonably  large  domain  S  [41].  Following  their  work  we  define  an  admissible 
norm  ||  •  ||  on  Q  as  any  norm  ||  •  ||  that  makes  (Q,  ||  •  ||)  a  Banach  space  and  satisfies 

||[A,fl]||<||A||||5||,  VA,Beg. 

Define  B{Q,p)  =  {A  €  Q  \  ||4||  <  p}.  Let  Cgo  be  the  connected  component  of 
Cg ,  the  center  of  G,  that  contains  the  identity  e  E  G. 

Theorem  2.8  (Lazard  and  Tits)  For  any  choice  of  admissible  norm  on  Q,  the 
restriction  of  exp  to  S  =  B(Q,  7r)  is  injective  if  and  only  if  Cgo  is  simply  connected. 
If  G  is  simply  connected  then  the  restriction  of  exp  to  S'  =  B(Q,  27t)  is  injective. 
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Remark  2.9  Cq o  is  simply  connected  for  finite-dimensional,  semi-simple  Lie 
groups  such  as  SO (n),  n  >  2,  and  SL(n),  n>  1,  since  the  center  of  such  a  group 
is  the  identity  element  which  is  trivially  simply  connected.  SE(n),  n  >  1,  and 
the  unipotent  group,  n  >  2,  also  have  a  trivial  center. 

Consider  a  matrix  Lie  algebra  Q  C  3ftnxn  and  the  induced  matrix  p-norm  ||  •  ||p 
on  5Rnxn.  We  can  always  construct  an  admissible  norm  as  ||  •  ||^  =  2||  •  ||p,  since 

IP,  B]|U  =  2|p, B]||p  =  2\\AB  -  BA\\P  <  4P||P||B||P  =  PIU||B||t. 

Thus,  for  any  G  for  which  Cqo  is  simply  connected,  we  can  let  S  —  {A  G 
Q  \  \\A\\l  <  7r}  =  {A  G  Q  |  ||j4||p  <  7r/2}.  Lazard  and  Tits  give  an  example 
admissible  norm  for  so(3),  se(2),  sl{ 2).  Given  the  appropriate  choice  of  basis 
{Ai,A2,A3}  for  so(3),  se(2),  sl( 2),  let  A  =  and  a  =  (ai,a2,d3)T ■ 

Then  ||v4||a-  =  ||a||2  is  an  admissible  norm.  Thus,  for  G  =  SO( 3),  SE(2)  or 
SL( 2)  and  Q  the  associated  Lie  algebra,  we  can  let  S'  =  {A  €  Q  |  H^Hk-  <  7r}. 

We  say  that  5i(e)  G  5R71  is  of  order  52(e),  denoted  6i(e)  =  0(52{e))  if  there 
exists  some  k  >  0  and  >  0  such  that 

||5i(e)||  <  kS2(e),  V|e|  <  ex.  (2.47) 

The  following  lemma  shows  that  for  G  a  matrix  Lie  group,  if  X  G  G  is  in  a 
sufficiently  small  neighborhood  of  the  identity  of  G  then  the  canonical  coordi¬ 
nates  of  the  first  and  second  kind  relative  to  the  same  basis  {Ai, . . . ,  An}  for  the 
associated  Lie  algebra  Q  are  close  of  small  order. 

Lemma  2.10  Given  X  G  Q  D  Q  C  G,  let  7  =  ^_1(2f)  and  Z  =  Then 

7  =  0(ep)  if  and  only  if  Z  =  0(ep),  p  >  1.  In  this  case,  ||t j  —  z,||  =  0(e2p),  i  = 
l,...,n. 
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Proof.  Given  X  we  expand  exponentials  in  the  two  local  representations  to  find 


that 


g7l^l  .  .  .  elnAn 


—  (I  +  llM  +  7M1/2  +  •••)'"  (I  +  7 nAi  +  7 n-^n/2  +  ■  ■  ■) 

=  I  +  ^  +  X]  7i^!/2  +  5Z  +  . . . ,  (2.48) 

4=1  4=1  4J=1 


and 


Z  =  e2  =  /  +  Z  +  Z2/2  +  . 


n 


n 


—  I  +  +  (7:  ZiAi)2 /2  +  .  .  .  . 

4=1  4=1 


(2.49) 


The  lemma  follows  by  equating  (2.48)  and  (2.49). 
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Chapter  3 


Examples 


In  this  chapter  we  describe  the  motion  control  applications  that  we  study  through¬ 
out  this  dissertation.  In  particular,  we  derive  the  relevant  state  equations  as 
systems  on  matrix  Lie  groups. 


3.1  Spacecraft  Attitude  Control 


As  our  first  example,  consider  the  spacecraft  attitude  control  problem.  Let 
(bi,  b2,  bs)  be  an  orthonormal  frame  fixed  on  the  body  and  let  (ri,  r2,  rs)  define 
an  inertial  frame  with  origin  coincident  with  the  origin  of  the  body-fixed  frame. 
Then  we  define  X(t)  €  50(3)  such  that  rj  =  X(t)bi,  i.e.,  X(t)  determines  the 
attitude  of  the  spacecraft  at  time  t.  Let  e\  —  (1,0, 0)T,  e2  =  (0,1, 0)r  and 
e3  =  (0,0, 1)T.  Define  $ft3  — »  so(3)  for  x  =  (xi,X2,x3)t ,  by 


0  -rr3  x2 

Xj,  0  —  xi 

—x2  x\  0 


(3.1) 
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Define  A{  —  e*,  i  =  1, 2, 3.  Then  {Ai,A2,  A3}  is  the  standard  basis  for  Q  —  so( 3) 
and  X(t)  satisfies 

3 

X  =  xCl,  Cl(t)  =  Y,  (3.2) 

2=1 

where  =  (Q,i,Q2,Q,z)t  is  the  angular  velocity  of  the  spacecraft  in  body-fixed 
coordinates.  If  we  let  euj  =  Dj,  i  =  1,2,3,  i.e. ,  if  we  interpret  the  components 
of  angular  velocity  as  our  small-amplitude,  periodic  controls  (see  Chapter  1  and 
Chapter  2),  then  (3.2)  takes  the  form  (2.11)  with  G  =  50(3)  and  n  =  3. 

We  will  be  most  interested  in  the  case  when  only  two  components  of  angular 
velocity  can  be  controlled,  i.e.,  when  m  —  2.  For  example,  if  we  can  control 
angular  velocity  about  the  bi  and  b2  axes,  then  X  satisfies 

X  =  eX(u1Al+u2A2).  (3.3) 

By  Theorem  2.1  (Brockett/Jurdjevic  and  Sussmann),  (3.3)  is  controllable  and  is 
a  single-bracket  system  since  [Ai,A2]  =  A3.  This  means  that  we  can  reorient  the 
spacecraft  as  desired  by  controlling  only  two  of  three  angular  velocity  components 
(e.g.,  roll  and  pitch  velocities). 

From  Section  2.3.1,  the  solution  to  (3.3)  can  locally  be  expressed  as  X(t)  = 
e7i(<Mie72(iM2e73(t)<43_  Wei-Norman  parameters  (71,72,73)  satisfy  (2.31) 

which  for  the  standard  basis  of  so(3)  defined  above  becomes 


7i 

sec  72  cos  73 

-  sec  72  sin  73 

0 

72 

=  e 

sin  73 

cos  73 

0 

73 

-  tan  72  cos  73 

tan  72  sin  73 

1 

eM(j)u,  (3.4) 


where  for  the  case  of  two  controls  (3.3)  we  set  u3  =  0.  The  matrix  M( 7)  is 
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nonsingular  for  I72I  <  7r/2,  and  the  Wei-Norman  parameters  can  be  interpreted 
as  Euler  angles.  Let  B  =  (bi,  b2,  bs)  and  E  —  (ri,  r2,  r 3)  and  define  the  rotations 
71)72,73  as  follows: 

•  Rotate  E  counterclockwise  about  the  ri-axis  by  angle  71  to  get  E. 

•  Rotate  E  counterclockwise  about  its  y-axis  by  angle  72  to  get  E'. 

•  Rotate  E'  counterclockwise  about  its  2- axis  by  angle  73  to  get  B. 

From  Section  2.3.2  we  can  also  express  the  solution  to  (3.3)  locally  as  a  single 
exponential  X{t)  —  ez^\  Z(t)  =  Yn=\Zi(t)Ai.  This  representation  is  equivalent 
to  the  well-known  Euler  parametrization  for  £0(3).  Given  X  —  ez  G  £0(3), 
Z  =  —<f>c  where 

<t>  =  <KX)  =  cos- 1  [o)jr] ( 1  /2 (tr (X )  -  1)),  (3.5) 

tr  is  the  trace  operator  and 

c  =  c(X)  =  ^—(X23  -  X32,X31  -  Xn,X12  -  X2l)T. 

Z  sin  (p 

As  an  alternative  to  the  metrics  d  and  d  defined  by  (2.38)  and  (2.46),  respec¬ 
tively,  on  a  neighborhood  of  the  identity  of  £0(3),  we  define  a  metric  4>  on  £0(3) 
which  gives  a  more  physical  measure  of  rotational  distance.  Let  X,X  e  £0(3). 
Following  Meyer  [55]  we  let  R  —  X~lX  =  XTX  and  let  <j)(R)  be  given  by  (3.5). 
R  G  £0(3)  describes  the  rotation  that  takes  X  into  X  and  4>{R)  defines  the 
magnitude  of  this  rotation.  By  [55], 

4> :  £0(3)  x  £0(3)  -»•  5R+,  B)  =  <f>(ABT)  (3.6) 

defines  a  metric  on  £0(3)  and  satisfies 

(f>(ABT)  <<t>(A)  +  <l>(B).  (3.7) 
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So  <})(XT,XT )  =  cj)(R )  describes  the  distance  between  X  and  X  on  50(3).  Fur¬ 
ther,  suppose  X(t)  and  X(t)  are  curves  in  50(3)  such  that  X  =  Xu,  X  —  Xu. 
Then  R(t)  =  XT(t)X(t)  also  is  a  curve  in  50(3)  and 

R  =  R&d,  fid  =  u  —  Rtu. 

fid  is  the  difference  in  body  angular  velocity  between  the  system  defined  by  X 
and  the  system  defined  by  X.  Let  R( 0)  =  I,  R(tf)  =  Rf ,  tf  >  0.  Meyer  showed 
that  for  any  fld{t), 

<t>(Rf)  <  [tf  \\fld(t)\\dt. 

Jo 

Thus,  4>(XT,  XT)  =  4>(R)  can  be  interpreted  as  the  minimal  angular  distance  be¬ 
tween  the  body  coordinates  of  the  system  defined  by  X  and  the  body  coordinates 
of  the  system  defined  by  X. 

The  interpretation  of  the  components  of  spacecraft  angular  velocity  fi  as  our 
control  inputs  eu  is  reasonable,  for  example,  if  we  suppose  that  zero  angular 
momentum  of  the  spacecraft  is  conserved,  i.e.,  that  the  spacecraft  is  not  spinning 
and  there  is  no  external  torque  applied.  We  describe  below  two  different  ways  of 
effecting  control  over  angular  velocity  under  these  circumstances. 

3.1.1  Internal  Rotors 

The  spacecraft  with  internal  rotors  is  illustrated  in  Figure  3.1.  Let  p  be  the 
number  of  rotors.  Assume  that  the  ith  rotor  spins  about  the  axis  d f  (unit  vector) 
which  is  fixed  in  the  spacecraft  such  that  the  center  of  mass  of  the  ith  rotor  lies 
on  the  di  axis.  Further,  di  is  a  principal  axis  for  the  ith  rotor,  and  the  ith  rotor  is 
symmetric  about  di.  Let  p  be  the  angular  momentum  of  the  spacecraft  measured 
in  inertial  coordinates  and  assume  that  p  =  0  is  conserved.  Define 
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Figure  3.1:  Spacecraft  with  Internal  Rotors. 

J*  =  inertia  matrix  of  spacecraft  without  rotors  in  body-fixed  coordinates. 
Ji  =  inertia  matrix  of  ith  rotor  measured  in  body-fixed  coordinates. 

Vi  =  Oidi  =  angular  velocity  of  ith.  rotor  in  body-fixed  coordinates. 


Hb  —  angular  momentum  of  body  in  body-fixed  coordinates. 


Then  by  [55,  18] 

=  XT [A  —  ^  Jj(n  +  Vi)  + 
2=1 

which  implies  that 


i= 1  i=  1 

Then  since  —  0, 

i=  1 

where  J  =  J*  +  Y%=  i  Ji  is  assumed  to  be  nonsingular  (which  it  will  be  in  general). 
Thus,  assuming  that  we  can  control  the  angular  velocities  of  the  internal  rotors, 
9i,  i  =  1, . . .  ,p,  we  can  control  some  or  all  of  the  components  of  0. 
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Figure  3.2:  Spacecraft  with  Appended  Point  Mass  Oscillator. 

3.1.2  Appended  Point  Mass  Oscillator 

The  spacecraft  with  an  appended  point  mass  oscillator  is  illustrated  in  Figure  3.2. 
We  assume  that  we  can  control  the  oscillation  of  the  point  mass  in  three  di¬ 
mensions.  (Alternatively,  the  problem  may  involve  undesirable  oscillations  of  an 
appended  point  mass  and,  thus,  we  study  the  resulting  attitude  drift  of  the  space¬ 
craft.)  We  assume  that  the  point  mass  has  no  associated  inertia  (matrix).  Let  y, 
be  the  angular  momentum  of  the  spacecraft  plus  oscillator  measured  in  inertial 
coordinates  and  assume  that  fj,  =  0  is  conserved.  Define 

y  =  distance  of  the  point  mass  from  the  spacecraft  center  of  mass  in  body-fixed 
coordinates. 

m0,  m i  =  mass  of  the  spacecraft  and  point  mass  oscillator,  respectively. 
am  =  m0mi/(m0 +  mi). 

To  =  inertia  matrix  of  the  spacecraft  without  the  oscillator. 
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Figure  3.3:  Overhead  View  of  Unicycle. 

Ziock  =  instantaneous  locked  inertia  of  body  plus  oscillator,  i.e.,  the  inertia  of 
the  system  frozen  at  y  in  body  coordinates.  Xiock  —  Xq  +  o:m(||y||2/  —  yyT) 
where  I  is  the  3x3  identity  matrix. 

fib  =  angular  momentum  of  body  in  body-fixed  coordinates. 

y  =  velocity  of  point  mass  in  body-fixed  coordinates. 

Then  by  [36] 

y>b  —  X  [a  —  (Ilockn  -(-  amy  x  y) . 

Since  //  =  0,  we  get  that 

ft  =  -lr0ck(y)am(y  X  y),  (3.8) 

assuming  that  Tiock(y)  is  nonsingular  (which  it  will  be  in  general).  Thus,  f 2  is 
driven  by  the  velocity  y  of  the  oscillator. 


3.2  Unicycle  Motion  Control 

As  our  second  example,  we  consider  the  unicycle  motion  planning  problem  shown 
in  Figure  3.3.  Let  the  configuration  of  the  unicycle  be  ( x,y,9 )  G  5R2  x  S1.  (x,y) 
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describes  the  unicycle’s  position  on  a  plane  relative  to  an  orthonormal  inertial 
frame  (ri,r2).  9  describes  the  orientation  of  the  unicycle,  specifically,  the  angle 
between  the  tangent  to  the  wheel  on  the  plane  and  the  ri-axis.  Assuming  the 
unicycle  wheel  rolls  without  slipping  and  u\  —  9  (steering  speed)  and  u2  =  v 
(rolling  speed)  are  available  as  controls,  then  the  system  can  be  described  by 

x  =  u2  cos  9 

y  =  u2smd  (3.9) 

9  =  U\. 


Alternatively,  let  (bi,b2)  be  an  orthonormal  frame  in  the  plane  fixed  on  the 
vehicle  such  that  bi  is  parallel  to  the  tangent  to  the  wheel  on  the  plane.  Define 
X{t)  E  SE{ 2)  by 


1 


=m 


bi 

1 


,  *  =  1,2. 


Then  X  ( t )  describes  the  position  and  orientation  of  the  unicycle  at  time  t  and 


cos  9 

—  sin0 

X 

X  = 

sin# 

cos  9 

V 

0 

0 

1 

Let 


- 1 

O 

-1 

1 

o 

- 1 

o 

0 

1 

1 

o 

0 

1 - 

o 

A\  — 

1 

0 

0 

j  M  — 

0 

0 

0 

)  M  — 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

(3.10) 


Then  {A1;  A2,A3}  defines  a  basis  for  se(2),  the  Euclidean  Lie  algebra,  and  X(t) 
satisfies 

X  —  eXi^AiUi  +  A2u2)  (3-11) 
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where  we  have  assumed  small-amplitude  controls.  Equation  (3.11)  is  of  the  form 
(2.11)  with  G  =  SE( 2),  n  —  3  and  m  =  2.  By  Theorem  2.1,  (3.11)  is  controllable 
and  is  a  single- bracket  system  since  [Ai,A2]  =  A3. 

Because  G  =  SE( 2)  is  solvable,  Lemma  2.3  ensures  that  at  least  one  choice 
of  ordered  basis  for  se(2)  yields  a  global  product  of  exponentials  representation 
of  X(t).  It  turns  out  that  more  than  one  choice  of  ordered  basis  gives  a  global 
solution.  For  the  representation  X(t)  =  e7df)^1e72(t)42e73(t)A3 }  the  Wei-Norman 
parameters  (71,72,73)  globally  satisfy 

71  =  ui 

72  =  73«1  +  U2 

73  -  -72«i  +  «3- 

u3  is  the  velocity  in  the  b2  direction,  i.e.,  along  the  wheel  axis.  For  the  unicycle 
problem,  U3  is  the  slipping  speed;  thus,  the  rolling  without  slipping  constraint 
implies  that  u3  =  0.  Further,  one  can  see  that  6  =  71  and 


X 

cos  9 

—  sin0 

72 

y 

sin  9 

COS0 

73 

i.e.,  (72,73)  describes  the  position  of  the  unicycle  with  respect  to  a  coordi¬ 
nate  frame  that  rotates  with  the  unicycle  but  has  its  origin  fixed  at  the  ori¬ 
gin  of  the  inertial  frame.  Coordinates  x,  y,  9  are  also  Wei-Norman  parameters 
and  (3.9)  Wei-Norman  equations  corresponding  to  the  global  solution  X(t)  = 
ex(t)A2ey(t)A3e8(t)Ai '  q^e  parameters  Zi,  z2,  Z3  in  the  representation  X(t)  =  ez^\ 
Z(t )  —  T,i=1Zi(t)Ai  are  identical  to  the  Wei-Norman  parameters  71,72,73,  i.e., 
Ziit)  =  7 i(t),  i  =  1,2,3. 
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Figure  3.4:  Autonomous  Underwater  Vehicle. 

3.3  Autonomous  Underwater  Vehicle  Motion 


Control 


Consider  an  autonomous  underwater  vehicle  (AUV)  as  in  Figure  3.4  and  let 
(bi,  b2,  bs)  be  an  orthonormal  frame  fixed  on  the  vehicle.  Similarly,  let  (ri,  r2,  rs) 
define  an  inertial  frame.  Then  we  define  X(t)  E  SE(3)  where 


X(t)  = 


- 1 

>< 

fo 

C-K 

xT{t) 

000 

1 

such  that 


XR{t)  E  50(3),  xT(t)  E  R3, 


x(t) 


bi 

i 

* 

S3 

_ 1 

1 

000 

1 

bi 

1 


XR(t)  bi  +  xr(t) 

1 


ri 

1 


Thus,  X  ( t )  describes  the  orientation  and  position  of  the  AUV  at  time  t.  Let 


ei 

0 

000 

0 

** 

0 

3 

000 

0 

i  =  1,2,3 

*  =  4,5,6. 


(3.12) 


Then  {A1;...,A6}  defines  a  basis  for  Q  =  se(3).  Let  O  =  (fi^fU^)7  define 
the  angular  velocity  of  the  vehicle  and  v  =  (vi,v2,v3)t  the  vehicle  translational 
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velocity,  all  with  respect  to  (bi,b2,b3).  Then  X{t )  satisfies 

3  6 

x  =  X(±ni(t)Ai  +  ±vi-3mi).  (3.13) 

i=l  i=4 

We  assume  that  we  can  interpret  Q(t)  and  v(t)  as  small-amplitude  controls  such 
that  (3.13)  is  of  the  form  (2.11),  e.g.,  we  let  eui  =  fij,  i  =  1,2,3  and  enj  = 
3,  i  —  4, 5, 6.  In  this  case  G  =  SE( 3)  and  n  =  6. 

As  in  the  spacecraft  attitude  control  problem,  we  are  interested  here  in  the 
case  when  fewer  than  n  control  components  are  available,  i.e.,  m  <  6.  For  exam¬ 
ple,  suppose  that  we  can  control  angular  velocity  about  bi,b2,b3  and  transla¬ 
tional  velocity  along  bi.  Then  X(t)  satisfies 

X  =  eX(£ui(t)Ai)-  (3.14) 

1=1 

By  Theorem  2.1,  (3.14)  is  controllable  and  is  a  single-bracket  system  since  [A3,  A4] 
=  A5  and  [A*,^]  =  A6.  Now  suppose  that  an  actuator  which  controls  one 
component  of  angular  velocity  fails.  If  the  failed  actuator  corresponds  to  the  first 
component,  i.e.,  ui(t)  =  0,  then  (3.14)  is  still  a  single-bracket  system.  However,  if 
the  actuator  for  one  of  the  other  components  fails,  say  u3(t)  —  0,  then  X  satisfies 

X  =  cX (uiA\  +  U2A2  “h  U4A4).  (3.15) 

System  (3.15)  is  still  controllable  but  now  a  double-bracket  system.  This  can  be 
seen  since  [Au  A2\  =  A3,  [A4,  A2]  =  A6  and  [[A^  A2],  A4]  =  A5. 


The  AUV  is  controllable  even  with  as  few  as  two  controls.  Suppose  one 
actuator  controls  angular  velocity  (denoted  by  eui)  about  an  axis  that  lies  in 
the  bi-b2  plane.  For  example,  suppose  that  it  controls  angular  velocity  about 
the  bi  and  b2  axes  equally.  Suppose  the  other  actuator  controls  angular  and 
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translational  velocity  about  the  b2  axis,  simultaneously.  This  second  actuator 
provides  a  screw-like  velocity  that  we  denote  by  eu2{t).  Define  =  A\  +  A2  and 
B2  =  A2  +  A5.  Then  X  satisfies 

X  =  eX(uxBi  +  u2B2).  (3.16) 

System  (3.16)  is  controllable  and  is  a  triple-bracket  system  since  (Bi,  B2,  [Bi,B2], 
[Bi,  [Bu  B2]\,  [B2,  [Bi,  B2]],  [Bu  [Bu  [Bi,B2]]})  span  se(3). 


The  Wei-Norman  parameters  (71, . . .  ,76)  in  the  product  of  exponentials  rep¬ 
resentation  X(t)  =  IlL  e^i{t)Ai  satisfy 


7i 

sec  72  cos  73 

-  sec  72  sin  73 

0 

0 

0 

0 

Ui 

72 

sin  73 

cos  73 

0 

0 

0 

0 

u2 

73 

—  tan  72  cos  73 

tan  72  sin  73 

1 

0 

0 

0 

u3 

74 

0 

-7e 

75 

1 

0 

0 

U4 

75 

76 

0 

-74 

0 

1 

0 

u5 

76 

-75 

74 

0 

0 

0 

1 

u6 

The  parameters  71,  72,  73  correspond  to  the  three  Euler- angle  type  parameters 
of  the  spacecraft  attitude  control  problem  (compare  with  (3.4))  and  parametrize 
the  orientation  of  the  vehicle.  The  parameters  74,  75,  76  parametrize  the  po¬ 


sition  of  the  vehicle.  Let  X 


(  v 

Xr 

xT 

^00  0 

1 

Then  XR  =  nL,  e** 


and 


xt  =  ^r(74,75,76)t-  Similarly,  consider  the  single  exponential  representa¬ 
tion  X(t)  =  ez^\  Z(t)  =  S®_i  Zi(t)Ai.  Z\,  z2,  z3  correspond  to  the  single  ex¬ 
ponential  parameters  of  the  spacecraft  problem,  i.e. ,  Xr  —  e^=i  z'^Ai ,  and 
Zi  =  7 i,  *  =  4,  5,  6. 
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Figure  3.5:  Uniform  Ball  Rolling  Between  Two  Parallel  Plates. 

3.4  Ball  and  Plate 

Consider  a  uniform  spherical  ball  rolling  without  slipping  between  two  parallel, 
flat,  rough  plates  as  in  Figure  3.5.  Let  (bi,b2,b3)  be  an  orthonormal  frame 
fixed  on  the  ball  with  origin  at  the  center  of  the  ball.  Let  (qi,q2,Q3)  be  an 
inertial  frame.  Let  (ri,r2,r3)  be  a  frame  translating  with  the  ball  that  has  its 
origin  at  the  center  of  the  ball,  but  has  its  orientation  coincident  with  the  inertial 
frame.  Let  r3  be  perpendicular  to  the  plates.  Assume  that  the  bottom  plate  is 
stationary  and  the  top  plate  can  be  vibrated  parallel  to  the  rj-r2  plane.  Further, 
assume  that  we  can  control  the  velocity  of  the  top  plate.  Let  U{(t)  be  the  velocity 
component  in  the  redirection,  i  =  1,2.  Let  y  —  (y1;  y2,  y3)T  describe  the  position 
of  the  center  of  the  ball  with  respect  to  (qi,q2>q3)-  Let  p  be  the  radius  of  the 
ball,  then  y3(t)  =  p.  Since  the  velocity  of  the  center  of  the  ball  is  equal  to  the 
velocity  at  the  top  contact  point, 


yi=ui(t),  y2  =  u2(t),  y3  =  0. 

Now  let  X(t)  €  50(3)  be  defined  such  that  rj  =  XTb{,  i.e.,  X(t)  describes 
the  orientation  of  the  ball  at  time  t.  Let  0  be  the  angular  velocity  of  the  ball 
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expressed  with  respect  to  (ri,r2,r3).  The  rolling  without  slipping  constraint 
implies  that 


Further,  assuming  zero  initial  angular  momentum  about  the  r3  axis,  by  conser¬ 
vation  of  angular  momentum,  fl3  =  0.  So  X ( t )  satisfies 

X  =  XCl  =  -^X{-Axu2(t)  +  A2ul{t)),  (3.18) 

where  A\,A2  G  so( 3)  are  as  defined  in  Section  3.1.  System  (3.18)  is  a  left- 
invariant  control  system  on  SO( 3)  of  the  same  form  as  the  spacecraft  attitude 
control  problem  with  only  two  velocity  components  available  as  controls.  In 
particular,  this  system  is  controllable  and  a  single-bracket  system. 

This  system  could  potentially  be  used  in  the  design  of  a  vibratory  actuator 
[33].  Suppose  that  we  control  small-amplitude  vibrations  of  the  top  plate,  e.g., 
with  piezo-actuated  flexural  members.  Since  (3.18)  is  controllable,  we  can  get 
net  rotation  of  the  ball  about  the  r3  axis.  Thus,  if  we  attach  a  (deformable)  gear 
drive  about  the  equator  of  the  ball,  we  can  convert  vibratory  motion  into  rotary 
motion  (see  Figure  3.6). 

3.5  Brockett’s  System 

Brockett’s  prototypical  nonholonomic  system  [13]  on  5?3  is  defined  (after  a  change 
of  variables)  as 

x  =  U\ 
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Figure  3.6:  Vibratory  Actuator  on  50(3). 

y  =  u2  (3.19) 

z  =  -uiy. 


In  the  terminology  used  by  Murray  and  Sastry  [60],  (3.19)  is  in  chained  form. 
However,  we  can  also  express  this  system  as  a  drift-free,  left-invariant  system 
on  the  three-dimensional  unipotent  matrix  Lie  group  (also  called  the  Heisenberg 
group)  denoted  by  H( 3).  Define  a  basis  for  the  associated  (nilpotent  of  order  2) 
Lie  algebra  h( 3)  as 
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Then  X  (£)  satisfies 

X  =  eX{A1u1(t)  +  A2u2(t))  (3.20) 


V 


Figure  3.7:  Overhead  View  of  Front- Wheel  Drive  Car. 

which  is  of  the  form  (2.11)  with  n  =  3,  m  =  2  where  we  have  assumed  small- 
amplitude  controls.  By  Theorem  2.1,  (3.20)  is  controllable  and  a  single-bracket 
system  since  \A\,A^  —  ^3-  Since  h( 3)  is  nilpotent  it  is  also  solvable.  Thus, 
Lemma  2.3  ensures  that  at  least  one  choice  of  basis  gives  a  global  product  of  expo¬ 
nentials  solution  for  X(t).  The  product  of  exponentials  X  (t)  =  ex^Aley^A2ez^A3 
is  a  global  solution  to  (3.20). 

3.6  Front- Wheel  Drive  Car  and  Other  Chained- 

Form  Systems 

Consider  the  front-wheel  drive  (kinematic)  car  of  length  l  shown  in  Figure  3.7. 
The  front-wheel  pair  and  the  rear-wheel  pair  are  each  modelled  as  a  single  wheel 
located  at  the  midpoint  of  each  axle.  We  assume  that  only  the  front  wheels  are 
allowed  to  turn.  The  car,  like  the  unicycle,  is  a  nonholonomic  system  if  we  assume 
that  the  wheels  do  not  slip.  The  configuration  of  the  unicycle  can  be  described 
by  ( x ,  y,  6,  (f>)  €  5ft2  x  S1  x  S1,  where  (a:,  y)  describes  the  car’s  position  on  a  plane 
relative  to  an  inertial  frame  (ri,r2).  (bi,b2)  is  an  orthonormal  frame  fixed  on 
the  car  as  shown  in  Figure  3.7.  6  denotes  the  orientation  of  the  car,  i.e.,  the  angle 
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between  the  bi  axis  of  the  car  and  the  ri  axis,  and  <j>  denotes  the  steering  angle, 
i.e.,  the  angle  between  the  bi  axis  of  the  car  and  the  front  wheels.  Assuming 
that  we  can  control  u\  =  0  (steering  speed)  and  u2  =  v  (rolling  speed),  then  the 
kinematic  state  equations  are 


x  =  u2  cos  9 
y  —  u2  sin  9 


9 


u2-  tan  <j>. 


(3.21) 


The  configuration  of  the  car  is  more  naturally  described  by  the  Lie  group 
SE(2)  x  S1.  SE( 2)  describes  the  position  and  orientation  of  the  car  (as  in  the 
unicycle  problem)  and  Sl  describes  the  angular  position  of  the  front  wheels.  For 
example,  let  X(f)  €  SE( 2)  xS'«  SE(2)  x  50(2)  be  defined  by 


Then  {A\,  A2,  A3,[A3,  A2}}  is  a  basis  for  se( 2)  x  so(2).  Let  Ui(t)  —  JqUi(t)cIt. 
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Then  X  ( t )  satisfies 


X  =  X(u\Ax  +  u2A2  +  -  tan(fii)u2A3), 

which  is  a  left-invariant  system  on  SE( 2)  x  S'1,  nonlinear  in  the  controls  U\,  u2. 

An  alternative  way  of  describing  the  kinematics  of  the  car  is  to  convert  (3.21) 
into  chained  form.  This  is  a  local  transformation  about  ( x,y,6,4 >)  =  0  of  the 
states  and  controls  of  (3.21)  given  by  Murray  and  Sastry  [60]  to  yield  the  following 
system  on  SR4, 


Xi 

=  Vi 

X2 

=  v2 

(3.22) 

X3 

=  X2V\ 

Xi 

=  X3Vi. 

Since  this  form  is  local  it  neglects  the  group  structure  of  the  configuration  space. 
However,  it  has  proved  useful  in  the  nonholonomic  motion  planning  literature  for 
constructing  motion  control  laws. 


System  (3.22)  can  be  expressed  in  our  formalism  as  a  left-invariant  control 
system  on  a  four-dimensional  subgroup  of  the  group  of  4  x  4  unipotent  matrices. 
This  matrix  Lie  group  consists  of  elements  of  the  form 


(  1  x2  x3  xA\ 


X  = 


0  1  X\  * 

0  0  1  X\ 


\  0  0  0  1 
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where  *  is  arbitrary.  A  basis  for  the  (nilpotent)  Lie  algebra  of  this  group  is  given 
by  {Ai,  A2,  A3,  A4}  =  {Ai,  A2,  [A2,  Ai],  [[A2,  Ai],  Aj]}  where 


( 


0 


0  0 


0  0 


\ 


A\  — 


0  0  1 
0  0  0 


y  0  0  0 


0 

1 


Ao  — 


0  0 


0  0 
^ 0  0 


0  0 
0  0 
0  0 


Then  X(t)  satisfies 


X  —  eX(AiV]_  +  A2D2) 


(3.23) 


which  is  of  the  form  (2.11)  with  n  =  4,  m  =  2,  where  we  have  assumed  small- 
amplitude  controls.  The  front-wheel  drive  car  described  by  (3.23)  is  controllable 
and  a  double-bracket  system.  The  product  of  exponentials  X(t)  —  ]li=i  eXi®Ai  is 
a  global  solution  to  (3.23). 


Other  more  general  chained-form  systems  can  equivalently  be  described  as 
left-invariant  control  systems  on  unipotent  matrix  Lie  groups.  Accordingly,  the 
theory  and  control  synthesis  algorithms  of  this  dissertation  can  be  applied  to  these 
systems.  The  connection  is  that  chained-form  systems  are  nilpotent  systems  in 
the  analogous  sense  that  unipotent  matrix  Lie  groups  have  nilpotent  Lie  algebras. 
For  example,  consider  the  two-input  chained-form  system  [59], 


Xi  =  Ui 

x2  =  u2 

x3  =  x2ui  (3.24) 

X4  =  x3u  1 

X/c  —  X^-lUl-. 
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It  has  been  shown  [71]  that  a  kinematic  car  with  n  =  k  —  3  trailers  can  be 
converted  into  the  form  (3.24).  System  (3.24)  can  be  expressed  as  a  left-invariant 
control  system  on  a  A;-dimensional  subgroup  of  the  k  x  k  unipotent  matrices, 
where  an  element  X  in  this  subgroup  takes  the  form 
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Chapter  4 


Averaging 


In  this  chapter  we  address  the  first  main  objective  of  this  dissertation:  to  describe 
solutions  (motion)  of  systems  on  Lie  groups.  To  do  so  we  derive  averaging  theory 
for  left-invariant  systems  on  finite-dimensional  Lie  groups.  These  systems  are 
described  by  (2.9)  of  Section  2.1.3  on  the  Lie  group  G  with  Lie  algebra  Q.  The 
goal  of  averaging  theory  in  this  context  is  to  describe  an  approximate  solution  to 
(2.9)  that  remains  close  to  the  actual  solution  and  that  evolves  on  G.  Classical 
averaging  theory  on  5ft"  does  not  meet  this  goal  because  it  is  restricted  to  systems 
which  evolve  on  5ft".  However,  one  can  apply  classical  averaging  theory  to  local 
solutions  of  (2.9).  We  derive  averaging  theory  for  systems  on  Lie  groups  by 
finding  average  solutions  to  the  product  of  exponentials  and  single  exponential 
local  representations  of  (2.9)  (see  Section  2.3). 

Averaging  theory  has  a  relatively  long  history.  It  is  linked  to  the  study  of 
oscillations  in  classical  mechanics  which  began  with  the  description  of  the  motion 
of  a  pendulum  in  the  days  of  Galileo  (1564-1642)  and  Newton  (1642-1727).  One 
can  find  the  origins  of  the  theory  of  small  oscillations  in  the  work  of  Lagrange 
(1736-1813)  and  an  explicit  statement  of  the  principle  of  averaging  in  the  work 
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of  Gauss  (1777-1855)  in  his  study  of  the  perturbations  of  planets  on  one  another. 
Ideas  related  to  averaging  theory  can  also  be  found  implicitly  in  the  work  of 
Laplace  (1749-1827).  Bogoliubov  and  Mitropolsky  published  a  classic  survey  of 
averaging  theory  in  the  early  1960’s  [9].  A  more  modern  treatment  is  given  by 
Sanders  and  Verhulst  [64],  We  make  reference  to  an  even  more  recent  treatment 
by  Khalil  [32], 

In  Section  4.1  we  present  our  results  based  on  the  product  of  exponentials 
representation  of  the  solution  g(t)  6  G  to  (2.9).  These  results  include  an  0(e) 
and  0(e2)  approximation  to  g(t )  for  t  €  [0,5/e],  6  >  0,  where  e  (0  <  e  <  1) 
is  the  small  parameter  representing  the  small  amplitude  of  the  periodic  forcing 
function  U(t)  6  Q  (see  the  end  of  Section  2.3.2  for  the  definition  of  0(52(e))).  In 
Section  4.2  we  present  our  results  based  on  the  single  exponential  representation 
of  g(t).  These  results  provide  a  more  general  0(eq),  q  >  1,  approximation  to 
g(t),  t  €  [0,6/e].  Additionally,  in  this  section  smoothness  assumptions  on  U(t) 
are  relaxed. 

In  both  of  these  sections  we  emphasize  the  geometric  interpretation  of  the 
average  solution  formulas.  This  interpretation  is  useful  for  solving  the  construc¬ 
tive  controllability  problem  as  will  be  shown  in  Chapter  5.  The  basic  idea  can  be 
illustrated  by  considering  the  system  on  5R3  defined  by 

x  =  Fi(x)ui  +  F2(x)v,2,  x  G  $R3,  (4.1) 

where  Fi(-)  and  F2(-)  are  smooth  vector  fields  on  9£3.  We  assume  that 

rank([Fi(ar)  F2(x)  [Fu  F2](a:)])  =  3,  Vz  €  5R3,  (4.2) 

where  [Fi,  F2](-)  is  a  new  vector  field  on  called  the  Lie  bracket  of  F\  and  F2 
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Figure  4.1:  Periodic  Controls. 

and  defined  by 

[Fi,F2](x)  =  ^(x)Fi(x)  -  fi(x)F2(x). 

By  a  well-known  theorem  (e.g.,  Proposition  3.15  of  [61]),  analogous  to  Theo¬ 
rem  2.1  (Jurdjevic  and  Sussmann),  assumption  (4.2)  implies  that  system  (4.1) 
is  controllable.  Specifically,  one  can  reach  any  point  in  5i3  by  flowing  along  the 
vector  fields  F\,  F 2  and  [Fi ,  F2]  which  span  9?3  at  every  point  in  9ft3. 


It  is  well  known  that  one  can  generate  flow  in  the  direction  of  [Fi,  F2]  using 
the  controls  u\  and  u2  specified  in  Figure  4.1(a).  These  controls  yield 

x(T)  -  :r(0)  =  e2[F1;  F2](x(0))  +  h.o.t., 

i.e.,  after  T  =  4  units  of  time  the  state  of  the  system  has  changed  in  magnitude  by 
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e2  in  the  direction  of  [F\,  F2\  evaluated  at  the  initial  condition  x(0).  Figure  4.1(b) 
shows  a  plot  of  U\  =  /q  Ui(r)dr  versus  u2  =  Jo  u2(r)dr  during  T  units  of  time.  It 
is  clear  that  the  magnitude  of  the  resulting  flow  can  be  expressed  as  e2  =  Area 
bounded  by  the  curve  described  by  u\  versus  u2  during  one  period.  As  Brockett 
argues  in  [14],  one  would  expect  a  similar  result  if  the  two  controls  were  some 
other  pair  of  small-amplitude  periodic  functions.  For  example,  the  controls  as 
depicted  in  Figure  4.1(c)  would  produce 


x(T)  —  x(0)  «  Area[Fi,  F2](x(0)), 


where  Area  is  the  shaded  area  of  Figure  4.1(d),  i.e.,  the  area  bounded  by  the 
closed  curve  described  by  ux  and  u2  over  one  period.  Then  in  some  average  sense 
one  would  predict  that 

The  theory  derived  in  this  chapter  generalizes  this  area-rule  result  to  systems  on 
Lie  groups  and  for  arbitrarily  high-order  (in  e)  approximations. 


In  Section  4.3  we  derive  the  secular  term  (linear  in  t)  in  the  0(e2)  area  rule 
from  the  curvature  form  of  a  certain  principal  fiber  bundle  with  connection.  This 
result  emphasizes  that  our  solutions  are  basis-independent.  In  Section  4.4  we 
present  some  stability  results  for  system  (2.9)  that  are  derived  from  the  averaging 
theory  of  this  chapter. 


4.1  Averaging  with  Product  of  Exponentials 

In  this  section  we  derive  first  and  second-order  averaging  theory  for  systems  of 
the  form  (2.9).  We  use  the  product  of  exponentials  local  solution  to  (2.9) 

g(t)  =  e7lWCl  •••e7"(t)*", 

given  by  Lemma  2.3  (Wei  and  Norman),  where 

7  =  eM{y)u.  (4.3) 

The  definitions  of  the  neighborhoods  S  C  3£n,  Q  C  G,  the  diffeomorphism  : 
5  — >  Q  and  the  metric  d  on  Q  which  we  use  in  the  following  theorems  can  be 
found  in  Section  2.3.1.  uav ,  Uav,  u  and  U  are  defined  by  (2.19)-(2.21). 

Theorem  4.1  (First-Order  Averaging)  Consider  system  (2.9)  on  the  Lie 
group  G  with  Lie  algebra  Q.  Assume  that  U(t)  G  £/  is  periodic  in  t  with  period  T 
and  has  continuous  derivatives  up  to  second  order  for  t  G  [0,  oo).  Let  D  =  {7  G 
j  ||7||  <  r}  C  S  (for  choice  of  r  see  condition  on  D  below).  Suppose  that 
g( 0)  =  go  G  Q.  Let  7 (t)  be  the  solution  to  (4.3)  with  7(0)  =  7o  =  '£~1  (<?())•  Let 
7 W(i)  G  5?n  and  g^(t)  G  G  be  defined  by 

7(1)  =  eM( 7(1))(^  Jq  u(r)dr)  =  eM(^{1))uav,  7(1)(°)  =  (4-4) 

p(1)(i)  =  e7i1)(t)6  •  •  •  =  g(o)etUa'1\  g\p  =  ^r(7o1)).  (4-5) 

If  H70  —  7o^||  =  0(e)  and  if  7 ^(t)  G  D,  Vi  G  [0, 6/e]  then, 

d(g(t),gw(t))  =  0(e),  Vi  G  [0,6/e]. 
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Proof.  By  classical  averaging  theory  ([32,  Theorem  7.4]), 


IM*)  -  7(1)(*)ll  =  0(e) ,  Vt  G  [0,  b/e). 

For  small  enough  e,  since  7 ^(t)  G  D  C  S  then  7 (t)  G  D  C  S,  Vt  G  [0,6/e].  So 
by  Lemma  2.3, 

g(t)  =  e71^1  •  •  •  e7"0)£"  =  vj/^t)),  Vt  G  [0, 6/e]. 


Define 

g^\t)  =  e7i  V)£n  =  \H(7^(t)),  Vt  G  [0,6/e]. 

Then,  by  definition  of  d , 


=  IItW  -7(1)WII  =  0(e),  Vt  G  [0,6/e]. 


By  Lemma  2.3,  g^(t)  as  defined  by  (4.6)  satisfies 


s<‘>  =  tTtLgmU„,  9(‘>(0)  =  9?>  = 


Since  Uav  is  constant,  (4.7)  has  the  global  solution 

gm(t)  = 


(4.6) 


(4.7) 


□ 


Remark  4.2  It  is  clear  from  (4.7)  that  g^(t)  describes  the  effect  of  the  DC 
component  of  U(t)  on  the  system  (2.9). 

Theorem  4.3  (Second-Order  Averaging  -  Area  Rule)  Consider  system 
(2.9)  on  the  Lie  group  G  with  Lie  algebra  Q.  Assume  that  U(t)  G  Q  is  periodic 
in  t  with  period  T  and  has  continuous  derivatives  up  to  third  order  for  t  G  [0, 00) 
and  assume  that  Uav  =  0.  Let  D  —  {7  G  3?"  |  ||7||  <  r}  C  S  (for  choice  of  r  see 
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condition  on  D  below).  Suppose  that  g(0)  =  go  £  Q-  Let  7 (t)  be  the  solution  to 
(4.3)  with  7(0)  =  70  =  ^_1(^o)  =  0(e).  Let  7^  =  (7iq2),  •  •  •  ,7no2))T  and  define 

1  m 

wk(t)  =  e2-  Y  Areaij(T)rltj  +  'Yktf),  (4.8) 

7 k]  (t)  =  euk  (t)+wk  (t) ,  (4.9) 

=  (4.10) 

where  and  Area,ij(T)  are  defined  by  (2.15)  and  (2.22),  respectively.  If  H70  — 
7o^||  =  0(e2)  and  if  7 ^(t)  £  D,Vt  €  [0,  b/e]  then, 

d(g (t) ,  g(2) ( t))=0 (e2) ,  VtE  1 0,  b/e] . 


Proof.  Following  classical  averaging  theory  we  define 


h(t,y)  =  M(y)u(t), 

v(t,  y)  =  [  h{r ,  y)dr  —  [  M(y)u(r)dr  =  M(y)u(t), 

Jo  Jo 

and  note  that  v(t,y)  is  periodic  in  t  with  period  T  since  uav  =  0.  Consider  the 
change  of  variables 

7  =  y  +  ev(t,y).  (4.11) 


Note  that  y(0)  =  jo  —  0(e).  Differentiating  (4.11)  with  respect  to  time  we  get 

dv  .  dv 

7 =y+%y+ew 


Substituting  (4.3)  for  7,  (4.11)  for  7  and  dv/dt  =  M(y)u(t)  gives 


eM(y  +  ev)u  = 


dv 

(I  +  e—)y  +  eM(y)u. 


(4.12) 
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By  (2.36)  of  Remark  2.4,  M(y)  =  I  +  61(7)  +  0(j2)  where  the  ij th  element  of 
a  is  defined  by  (2.35)  and  0(y2)  represents  terms  that  are  quadratic  and  higher 
order  in  the  components  of  7.  Since,  additionally,  M(y)  is  analytic  in  7,  then 

M(y  +  ev)  =  I  +  a(y  +  ev)  +  0((y  +  ev)2) 

=  I  +  a(y)  +  ea(v)  +  0(y2)  +  eO{yv)  +  e2p1(t,  y,  e) 

=  M(y)  +  ea(v)+eO(yv)  +  e2pi(t,y,e)  (4.13) 

where  0(yv)  is  quadratic  or  higher  order  in  the  components  of  y  and  v.  pi(t,  y,  e) 
is  periodic  in  t  with  period  T.  Substituting  (4.13)  into  (4.12)  gives 

dx) 

eM{y)u  4-  e2a(v)u  4-  e20(yv)u  4  e3pi(t,  y,  e)u  =  (/  4-  e— )y  +  eM(y)u.  (4.14) 

Since  dv/dy  is  t-periodic  and  thus  bounded  for  all  (t,  y)  E  [0,oo)  x  D,  for  small 
e  >  0,  (I  +  edv/dy)  is  nonsingular  and 

,r  ,  r  8V  ox 

=I~%+° (e)- 

Multiplying  both  sides  of  (4.14)  by  (/  4-  edv/dy )_1  gives 

y  =  (I-e—  +  0(e2))(e2a(v)u  +  e20{yv)u  +  e3pi(t,y,e)u) 

=  e2a(v)u(t)  4  e20(yv)u(t)  +  e3p2(t,  y,  e) 

where  p2(t,  y,  e)  is  periodic  in  t  with  period  T. 

Now  if  we  let  s  =  et,  then 

^  =  ea(v)u(s)  +  eO(yv)u(s )  +  e2p2(^,  y ,  e)  =  F(s,  y,  e).  (4.15) 

Define  y0(s)  by 

^T  =  F(s,y0, 0)  =  0,  y0(0)  =  0. 
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Then  y0(s)  =  0,  Vs  >  0.  Define  yi(s)  by 


dy i 
ds 


(dF  dF  N 

y Vo,  0)y1(s)  +  —  (s,  y0, 0) 

(a(v(s,y0))u(s))  |w=0 

{a(M{y0)u{s))u{s))\yo=0 

a(M  (0)u(s))u(s) 

a(u(s))u(s),  ey^O)  =7o. 


yo=o 


By  standard  perturbation  theory  (c.f.  [32,  Theorem  7.1]),  since  yo(s)  €  D,  Vs  > 
0,  3e*  >  0  such  that  V|e|  <  e*  (4.15)  has  the  unique  solution  y(s)  defined  on  [0,  b ], 
b  >  0,  such  that 

llvto  -  (llbOO  +  mis)) II  =  Ms)  -  qfiWII  =  0(e2). 

Now  let  w  =  eyi  then 

||y(f)  -  w(t)||  =  0(e2),  Vt  £  [0,  bf e],  (4.16) 

w  =  e2a(u(t))u(t),  w(0)  =  70 . 

Let  ui(t )  be  the  solution  to 

1  /*T 

w  =  e2  —  /  a(u(a))u(a)da,  w(0)  =  'y^\  (4-17) 

T  Jo 

From  the  definition  of  a  (2.35),  the  /cth  component  of  the  vector  a(u)u  is 

m  mm 

£>*(«)«<  =  £  £  rjidjUi.  (4.18) 

i=l  j=l  j=i+ 1 

So  using  integration  by  parts,  the  fact  that  T^  =  — T^,  w,  =  m  and  the  definition 
of  Area,ij(T )  (2.22)  we  get  from  substituting  (4.18)  into  (4.17)  that 
t  fT  m 

Wk(t)  =  e2—  /  J2aki(u{v))ui(a)da  +  7*^ 

T  Jo  i= 1 
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-i-  lib  lib  »  j 

=  E  /  r i<«i(ff)«i(ff)^  +  7fco2) 

a  2—1  j=2+l  1/0 
^  m  ^  -71 

=  e2-  £  -  (uj(a)ui(a)-ui(<T)uj(a))daT^i  +  'yk(o 

1  i,j—l-,i<j  Z  70 

t  m  1  fT  ■  ■  (‘ 

=  E  9  {ui(a)uj(a)-uj(a)ui(a))dar^j+'yk{o 


(2) 

0 

(2) 


iJ=l;t<j 

t  m 


=  e2f  E  ^reay(T)rfj  +  7fco  - 

i,j—l]i<j 

Let  7 (2)(t)  =  h)(i)  +  eit(i).  By  assumption,  7 ®(t)  G  D,  Vi  £  [0,6/e].  So,  for 
small  enough  e,  u)(i)  E  .D,  Vi  E  [0,  6/e].  Thus,  by  classical  averaging  (Theorem 
7.4  [32]), 

||iu(i)  -  u)(i)||  =  0(e2),  Vi  6  [0, 6/e].  (4-19) 

So  by  (4.16)  and  (4.19) 

\\y{t)  -  w(t)\\  =  ||y(i)  —  w(t)  +  w(t)  —  th(i)[| 

<  ||y(t)-w(t)||  +  |Kt)-«>(t)|| 

=  0(e2),  Vi  E  [0,6/e]. 


Additionally, 


|«/(i,tf)  -  e«(i)||  =  \\eM (y)u(t)  -  e«(i)|| 

=  ||(M(y)  -  I)eu(t)\\ 

=  ||0(c)cu(i)|| 

=  0(e2),  Vi  E  [0,6/e]. 


Then  by  (4.11),  (4.20),  (4.21), 


l|7(i)  -  7(2)(i) II  =  ||y(i)  +  eu(i, y)  —  w(t)  —  ett(i)|| 

<  ||y(*)  “  w{t)  ||  +  ||ev(i,  y)  -  eu(i))  || 
=  0(e2),  Vi  E  [0,6/e]. 


(4.20) 


(4.21) 


(4.22) 
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For  small  enough  e,  since  7 ^(t)  G  D  C  S  then  7 (t)  G  D  C  S,  Vt  G  [0,6/e].  So 
by  Lemma  2.3, 

g(t)  —  e71^1  •  •  •  e7"0)?n  =  Vt  G  [0, 6/e]. 

Define 

g^2\t)  =  e7i  )^t^1  •  •  •  e7" >(i)^n  =  \&(7^(t)),  Vt  G  [0,6/e]. 

Then  by  definition  of  d, 

d{g{t),g(2){t))  =  ||7 (t)  —  7(2)C0II  =  °(e2)>  Vi  €  [0,6/e].  □ 

We  show  further  in  the  next  proposition  that  the  structure  constants  T-) 
associated  to  a  given  basis  for  Q  are  directly  related  to  the  Lie  brackets  of  the 
vector  fields  defined  by  the  columns  of  M(v)  evaluated  at  7  =  0. 

Proposition  4.4  Suppose  that  w(t)  is  defined  by  (4.8).  Let  [f\  /2  •••  fn\  = 
M( 7)  where  /fc  is  the  kth  column  of  the  matrix  M( 7).  Then 

w(t)  =  Y  L  Areaij(T)[fi,  fr] |7=0  +  7o2)-  (4.23) 

Proof.  By  (2.35)  and  (2.36)  of  Remark  2.4  we  have  that 

ELi+1  +  0(72) 

KUh  7*r<*-»  +  0(72) 

/.=  1  +  EU.  tit*  +  0(72)  • 
awrf+oM 

£Z.i+.  7*r«  +  o(72) 
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So  /j|  0  =  ej  where  e*  is  the  zth  standard  basis  vector  for  3?n  and 


dh 

d 7 


7=0 


o  •••  o  r[i+1)i  •••  rb 


0  •••  0  Tfi+1)i  ...  rnni 


So  for  i  <  j, 


\t.  f .11  =  ?Ii 

IJuJj  Jl7=0 


f.l 

dh 

j 

7=0 

1  W=° 

rb 

rh 

e:S> 

1  ij 

fj  7=0 


7=0 


which  by  (4.8)  completes  the  proof. 


□ 


Remark  4.5  According  to  Theorem  4.3,  the  second-order  approximation  g^(t) 
to  solutions  g(t)  of  (2.9)  can  be  expressed  as  a  product  of  exponentials  where  the 
exponents  have  an  0(e)  periodic  term  and  a  secular  term  (a  term  linear  in  t).  By 
(4.8)  the  secular  term  is  proportional  to  the  structure  constants  T-  associated  to 
{£i, . . .  ,Cn}  and  the  areas  Area,ij(T )  bounded  by  the  closed  curves  described  by 
Ui  and  uj  over  one  period.  This  interpretation  justifies  calling  Theorem  4.3  an 
area  rule. 

The  next  corollary  illustrates  averaging  for  system  (2.11)  on  the  matrix  Lie 
group  G  =  50(3)  where  the  error  estimate  is  given  in  terms  of  the  metric  (j)  on 
50(3)  defined  by  (3.6)  in  Section  3.1. 


67 


Corollary  4.6  Consider  system  (2.11),  the  matrix  version  of  system  (2.9),  where 
G  —  50(3),  X(t)  G  50(3)  is  the  solution  to  (2.11)  and  {Ai,A2,A3}  is  the 
standard  basis  for  Q  =  so(3)  as  defined  in  Section  3.1.  Assume  U(t)  G  so(3)  is 
as  in  Theorem  4.3.  Let  D  =  {7  G  |  I72I  <  7r/2  —  8,  8  >  0}  (for  choice  of  8  see 
condition  on  D  below).  Let  X(0)  =  X0  G  Q.  Let  7 (t)  G  5i3  be  the  solution  of  the 
Wei-Norman  equations  for  50(3)  given  by  (3.4)  with  7(0)  =  70  =  4,_1(A’0)  = 
0(e).  Define 

7i2)(t)  =  eux{t)  +  e2^Area23(T)  + 

7 2](t)  =  eu2(t)  +  e2^Arean(T)  +  ”/2o\  (4.24) 

7 32)M  =  eu3(t)  +  e2^Area12(T)  +  'y3{o\ 

X{2)(t)  =  e7i2)(t)Ale722)(t)A2e732>(tM3.  (4.25) 

Then  if  ||70  -  ‘ivf'i  =  0(e2)  and  if  €  D,  Vf  C  [0,  b/e], 

}(X(t),X^(t))  =  0(e%  Vf  e  [0,6/e]. 


Proof.  Since  Tf2  =  r23  =  r31  =  1  are  the  nonzero  structure  constants  for  the 
given  basis  for  so(3),  7 ^(t)  as  defined  by  (4.9)  reduces  to  (4.24).  By  Theorem  4.3, 

||7(()-7t2)WII=0(e2),  Vf  £  [0,6/e],  (4.26) 

We  note  that  D  is  small  enough  to  ensure  that  the  Wei-Norman  equations  are 
well-defined  V7  G  D.  We  need  not  restrict  D  to  be  contained  in  5  (as  we  do  in 
Theorem  4.3),  since  we  do  not  use  the  diffeomorphism  'L  to  define  a  metric  on 
50(3)  in  this  corollary.  By  (3.6) 

4>(X,XW)  =  ct>{XX^T)  =  cos-1[0,7r](l/2(tr(XX(2)T)  -  1)). 
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Since  tr(ABC)  =  tr(BCA)  —  tv(CAB), 

tr(XX(2)T)  =  tx{ellMel2A2eliMe-^)Aie-^)A2e-^)Al) 

=  tr(e72A2e^'y3_732)^A3e“722)/l2e^7l_7i2)^1). 

Since  by  (3.7),  <f>{ABT)  <  <j>(A)  +  0(B), 

0(XX(2)T)  =  0(e72A2e(73  -732)^3e-722)^2e{7l-7i2))Al) 

<  0(e72A2e(73  -732))A  3e-722>A2)  +  0(e(7i2)-7l)Al) 

=  0(e^3-T'32))^3e(72-7f))A2^  +  0(e(7p}-7i)Ai) 

<  0(e(73_732))>i3)  +  0(e(7 i2)-v)A2]  +  0(e(7i2)-7iMi^  (4.27) 

By  direct  computation,  tr(exp(ajA*))  =  2cos(a,)  +  1,  i  =  1,2,3.  Therefore, 

0(c±(  7i'7-2))Ai)  =  cos^](i(2cos(7i-7f))  +  l-l)) 

=  COS[0^r](COS(7i  -  7i2))) 

=  |7i-7l2)|,  *  =  1,2,3.  (4.28) 

It  follows  from  (4.26),  (4.27),  (4.28)  that 

i(x(t),x^(t))  =  ^x(t)x^T(t))  <  Shift) -Tp’WI 

=  il7(t)-7<2>(t)lli 
=  0(7,  vt  e  [0,6/4  a 

Remark  4.7  We  can  draw  similar  conclusions  for  other  metrics.  For  example, 
given  the  assumption  in  Corollary  4.6  we  can  show  that  \\X(t)X^T (t)  —  I \\i  = 
0(e2),  Vt  €  [0,6/e].  This  can  be  shown  by  directly  computing  X(t)XWT (t)  —  I. 
The  bound  on  the  norm  can  then  be  found  using  trigonometric  identities  and  the 
fact  that 

S  l7i  -  7i2)|  =  117  -  7<2)lll  =  0(7  =>  |7i-7,®l  =  0(7,  *  =  1,2,3 
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=»  |  sin(7j  —  7i2))|  =  0(e2),  |  cos^  -  7^)  -  1|  =  0(e2),  i  =  1, 2,3, 
for  small  enough  e. 


4.2  Averaging  with  Single  Exponential 

In  this  section  we  derive  averaging  theory  for  systems  of  the  form  (2.9)  using 
the  single  exponential  representation  of  solutions  described  in  Section  2.3.2.  This 
representation  is  more  natural  for  our  purposes  than  the  product  of  exponentials 
representation,  and  we  are  able  to  derive  a  more  general  gth-order  averaging 
theory  {q  >  1).  We  consider  the  basic  ideas  of  classical  averaging  theory  to  derive 
the  theory  of  this  section,  but  we  do  not  directly  use  the  results  from  classical 
averaging  theory.  One  important  consequence  of  this  is  that  the  forcing  function 
U(t)  G  Q  need  only  be  piecewise  continuous  rather  than  smooth  as  assumed  in 
Theorems  4.1  and  4.3  and  generally  in  classical  averaging  theory. 

Consider  the  single  exponential  representation  g(t)  =  ez^  for  the  solution  to 
(2.9),  where  Z(t)  6  Q  is  given  by  the  infinite  series  Z(t)  =  l)t+1elZj(£) 

of  Corollary  2.7  and  Zi(t)  is  defined  by  (2.43)  (Fomenko  and  Chakon).  Let 
Zi  =  dZi{t)/dt  which  can  be  computed  by  differentiating  (2.43)  as 

Z\(t)  =  To(t)  =  U(t), 

(i l)Zi+i(t)  —  Ti  + '^2{-[Zr,Ti-r\  + -\Zr,Ti-r\  (4.29) 

r=l 

+  ^2  p  53  [Zm2,  ■■■  ,  [Zm2p,Ti-r\  ...]  +  ..  . 

p>l,2p<r  £*iTOj=r>ny>0 

T  [Zm\  >  [Zm,2  >  •  •  •  )  [Zm,2P  >  Tj_r]  .  .  .]  +  [Zmi ,  [Zm2 ,  .  .  .  ,  [Zm 2p ,  Tj_r]  .  .  .] )  } , 

Tk{t)  =  [U{t),  [  [U{t2),...,  [  U(Tk+i)drk+i]dTk] . .  .dr2\, 

Jo  Jo 
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The  following  lemma  shows  the  conditions  for  which  the  terms  in  the  series 
expression  for  Z(t)  are  periodic  in  t. 

Lemma  4.8  Let  <7  >  2  be  a  positive  integer  and  let  U(t  +  T)  =  U(t ),  \/t  >  0.  If 

Tk(T)  =  0,  k  =  0,...,q- 2,  (4.30) 

then  Vf  >  0, 

(a)  Tk(t  +  T)  =  Tk(t),  k  =  0, . . .  ,q  —  2. 

(b)  Tk(t  +  T)  =  Tk(t),  k  =  0,  1. 

(c)  Zi(t  +  T)  =  Zi(t),  i  =  l,...,q-  1. 

(d)  Zi(t  +  T)  =  Zi(t),  i  =  l,...,q. 

Proof.  Assume  (4.30)  holds.  We  prove  (a)  by  induction.  For  q  =  2  assumption 
(4.30)  implies  To(T)  =  0.  Then 

rt+T 

T„(t  +  T)  =  /  U{r)dr 
Jo 

rT  rt-\-T 

=  /  U(t)cIt+  /  f/(r)dr 

Jo  Jt 

=  T0(T)  +  r  £/(a  +  T)da  (4.31) 

Jo 

=  0  +  /  U(a)da 
Jo 

=  T0(t), 

where  we  set  cr  =  r  —  T.  Now  assume  (a)  holds  for  (7  =  <7'.  Then  we  must  show 
that  (a)  holds  for  q  =  q'  +  1  assuming  Tk(T)  =  0,  k  —  0, ...  ,q'  —  1.  Since  (a) 
holds  for  q  =  q',  Tk(t  +  T)  =  Tk(t )  for  k  =  0, . . . ,  q'  —  2.  So  we  need  only  show 
Tq'-\{t  +  T)  =  Tqi-lit). 

rt+T 

Tq,^(t  +  T)  =  /  [t^rO.T^nMdn 

J  0 
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rT  ft-\-T 

=  /  [C/(ri),Tg/_2(r1)]rfr1  +  /  [t/(n),Tg»_2(ri)]dri 

Vo  Jt 

=  Tq'_i(T)  +  /V^+n^-^+T)]^! 

J  0 

=  0+  [  [u(t 7i),T9/_2((Ti)]dai 

Jo 

=  Tqi-i(t), 

where  we  set  oi  =  n  —  T.  Thus,  (a)  holds  by  induction. 

Conclusion  (b)  follows  as  a  result  of  (a).  By  (4.29) 

Tk(t)  =  [U(t),Tk_1(t)], 

and  by  (a)  Tk(t  +  T)  —  Tk(t)  for  k  =  0, . . . ,  q  —  2.  So  for  k  =  0, . . . ,  q  —  1, 

Tk(t+T)  =  [uit+nn^t+T)} 

=  [£/(*),  ?U(<)] 

=  Tk(t). 

We  prove  (c)  by  induction.  Let  q  =  2.  Since  Zx  =  T0,  by  (4.31)  Zx(t  +  T)  = 
Z\{t).  Now  assume  (c)  holds  for  q  =  q'.  We  show  that  it  holds  for  q  =  q'  +  1 
assuming  Tk(T )  =0,  k  =  0, . . . ,  q'— 1.  Since  (c)  holds  for  q  —  q',  Ziit+T)  —  Zi(t) 
for  i  =  1, . . . ,  q'  —  1.  So  we  need  only  show  Zq'(t  +  T)  =  Zqi(t).  However,  from 
(2.43)  Zq'(t)  is  a  function  only  of  terms  2)(t)  and  Zi(t),  l  =  l, . . .  ,q'  —  1.  By  (a) 
Ti(t+T)  =  Ti(t),  l  =  1, . . .  ,q'  —  1.  By  the  induction  hypothesis,  Zi(t+T)  —  Zi(t), 
l  =  1, . . .  ,q'  —  1.  Thus,  Zqi(t  +  T)  =  Zq'(t),  and  (c)  holds  by  induction. 

Finally,  we  prove  (d)  by  induction.  Let  q  =  2.  We  have  Z2(t)  =  \Tx{t). 
So  by  (b)  Z2(t  +  T)  —  Z2(t).  Now  assume  (d)  holds  for  q  =  q'.  We  show 
that  it  holds  for  q  —  q'  +  1  assuming  Tk(T )  =  0,  k  =  0, . . . ,  q'  —  1.  Since  (d) 
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holds  for  q  =  q1,  Z{(t  +  T)  =  Zj(t)  for  i  =  1, . . .  ,5'.  So  we  need  only  show 
that  Zq'+\{t  +  T)  —  Zq  '+i(t).  From  (4.29)  we  have  that  Zqi+i(t)  is  a  function 
only  of  terms  Tj(t),  j  =  1, . . . ,  q'  -  1  and  T;(t),  Zt(t),  Zi(t),  l  =  l,...,q'.  By  (a), 
Tj(t+T)  =  7}(f),  j  =  l,...,q'-l.By  (b),  T,(t+T)  =  T|(f),  I  =  1, . . . ,  (f .  By  (c), 
+  T)  =  Zi(t),  l  =  1, . . . ,  q'.  By  the  induction  hypothesis,  Zi(t  +  T)  =  Zi(t), 
l  —  1, ...  ,q'.  Thus,  Zqi+i(t  +  T)  =  Zq>+i(t),  and  (d)  holds  by  induction.  □ 

The  next  series  of  theorems  provide  increasingly  simplified  approximations 
to  the  single  exponential  representation  of  g(t).  In  Theorem  4.9,  the  first  of 
the  series,  we  give  a  condition  that  ensures  a  valid  local  representation  on  an 
0(1/ 1)  time  interval.  Further,  we  show  for  Q  a  nilpotent  Lie  algebra,  that  g(t) 
can  be  represented  as  the  exponential  of  a  finite  sum.  The  definitions  of  the 
neighborhoods  S  C  Q,  Q  C  G,  the  diffeomorphism  ^  :  S  — >•  Q  and  the  metric  d 
on  Q  which  we  use  in  the  following  theorems  can  be  found  in  Section  2.3.2. 

Theorem  4.9  Consider  system  (2.9)  on  the  Lie  group  G  with  Lie  algebra  Q. 
Assume  that  U(t )  is  a  piecewise  continuous,  bounded  curve  in  Q.  Let  b  >  0 
be  such  that  Joll^(r)IMr  <  5,  Vt  G  [0,6],  where  5  is  as  defined  in  Theo¬ 
rem  2.6.  Then,  g(t)  =  g0e is  the  solution  to  (2.9),  Vt  €  [0,6/e]  where 
Z(t)  =  Tyi^i(—^y+1^Zi(t),  Zi(t)  are  defined  by  (2.43)  and  c/(0)  =  go  E  G. 
Suppose  that  Q  is  nilpotent  of  order  l.  Define 

4“(t)  = 

i=l 

Then, 

g(t)  =  3oez"(<),  [0,6/e]. 
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Proof.  Let 


K  =  swp  ||t/(t)||. 
t>o 

Let 

‘4- 

Then,  Vt  G  [0,  b], 

\\U(T)\\dT  <  [b\\ U(t)Mt<  [b  Kdr  =  Kb  <  6. 

Jo  Jo  Jo 

Further,  Mt  G  [0, 6/e], 

t  e||£/(r)||rfr  <  ellt/MlIrfr  <  eKdr  =  Kb  <  S. 

Jo  Jo  Jo 

As  a  result,  by  Theorem  2.6  (Fomenko  and  Chakon)  and  Corollary  2.7,  gift )  — 
Vt  €  [0, 6/e],  Z(t)  =  ESi(-l)‘+1«‘^W- 
For  nilpotent  of  order  l,  all  Lie  brackets  on  Q  of  depth  greater  than  l  —  1 
are  zero.  Zi(t)  is  composed  of  depth- (i  —  1)  brackets  on  £7;  therefore,  Zi(t)  =  0, 
i  >  l.  So  Z(t)  is  the  finite  sum  Z^(t).  D 

In  the  next  theorem  we  show  that  for  any  Q,  g(t )  can  be  represented  approx¬ 
imately  as  the  exponential  of  a  finite  sum.  We  also  show  that  if  #(0)  G  G  is  in 
a  small  enough  neighborhood  of  the  identity  e  G  G,  then  #(0)  can  be  subsumed 
into  the  single  exponential  representation  of  g(t). 

Theorem  4.10  Consider  system  (2.9)  on  the  Lie  group  G  with  Lie  algebra  Q. 
Let  U(t)  and  b  be  as  assumed  in  Theorem  4.9.  Let  q  >  1  be  an  integer.  Suppose 
that  g(0)  =  g0  G  Q  C  G  is  such  that  Z0  =  W-1^)  =  0(eq~1)  if  q  >  1  and 
Zq  =  O(e)  if  q  =  1.  Define 

Z[q\t)  =  £(-i)i+V  Zi(t)  +  zl>9\ 

i= 1 

g®{t)  =  ez“W, 
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(4.32) 

(4.33) 


where  Zi(t)  are  defined  by  (2.43).  If  || Z0  -  Z^\\  =  0(eq)  and  Z^(t)  £  S, 
it  £  [0, 6/e],  then 


d(g(t),g[q]{t))  =  0(eq),  it  £  [0, 6/e]. 


Proof.  As  in  Theorem  4.9  we  have  g(t )  =  goez^\  it  £  [0,6/e]  where  Z(t)  = 
l)l+1tlZi(t).  Since  g0  =  ez° ,  by  the  Campbell-Baker-Hausdorff  formula 
we  have  that  for  small  enough  e, 

5(t)  =  e  =  e1^,  Vt  £  [0,6/e]. 

W(t)  £  Q  can  be  expressed  as  the  following  convergent  series: 


W(t)  =  Z(t )  +  Z„  +  i[Z„,  Z(t)}  +  i([[Z„,  Z(f)],  Z(()]  +  [[Z(i),  Z„],  Z„l)  +  . . . . 

(4.34) 

So,  substituting  in  (4.34)  the  expression 


Z(t)  =  Z®(t)  -  zf  +  £  (-1  Y^e'Ziit) 


i=q+ 1 


as  well  as  Z(i)  =  0(e)  and  Z0  =  0(ee  1 )  gives 


W(t) 


OO  1 

zW(t)  +  (Z„-Z^)+  £  (-l)i+1eiZj(t)  +  -[0(e»-1),0(e)]  +  ... 

i=9+l  1 

Z[q](t)  +  0(eq).  (4.35) 


Since  Z^(t)  £  S',  it  £  [0, 6/e],  for  small  enough  e,  IT(t)  £  5,  W  £  [0, 6/e].  Thus, 
<?(t)  =  ^(IT(t))  £  Q  and  g^(t)  =  ^f(Z^(t))  £  Q,  it  £  [0,6/e].  It  follows  from 
the  definition  of  d  (2.46)  and  (4.35)  that 


d(g(t),gM(t))=\\W(t)-ZW(t)\\=0(e'),  Vie  [0,6/e].  □ 
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In  the  next  theorem  we  show  that  the  gth-order  finite  sum  approximation  of 
Z  (t)  can  be  further  simplified  by  replacing  the  qth.  term  in  the  sum  with  its  time 
average.  This  theorem  is  our  general  <?th-order  averaging  theorem  which  we  also 
refer  to  as  the  Area-Moment  Rule. 

Theorem  4.11  (qth-Order  Averaging  -  Area-Moment  Rule)  Consider 
system  (2.9)  on  the  Lie  group  G  with  Lie  algebra  Q.  Let  U(t)  and  6  be  as 
assumed  in  Theorem  4.9.  Further,  assume  that  U(t)  is  periodic  in  t  of  period 
T,  Vt  G  [0,  oo).  Let  q  >  1  be  an  integer.  For  q  >  1  assume  that  T^(T)  =  0, 
k  =  0, . . . ,  q— 2,  where  Tk(t)  is  defined  by  (2.43).  Suppose  that  g( 0)  =  g0  G  Q  C  G 
is  such  that  Z0  =  4r_1(^o)  =  0(e9_1)  if  q  >  1  and  Zq  —  0(e)  if  q  =  1.  Define 

Z“(i)  =  E(-l)i+1e‘Zi(()  +  (-l),+1e4z,(T)  +  45).  (4.36) 

i- 1  ± 

gto\t)  =  ezM{t\  (4.37) 

where  Zi{t)  are  defined  by  (2.43).  If  || Z0  —  Zq^\\  =  0(e9)  and  Z(q\t)  G  S, 
Vt  G  [0, 6/e],  then 

d(g(t),9M(t))  =  0(e<),  Vi  €  [0, 6/e].  (4.38) 

Further,  for  t  =  NT,  N  an  integer, 

Ziq\NT )  =  (-1  )q+1eqNZq{T)  +  zjfK  (4.39) 


Proof.  From  Theorem  4.10,  g(t)  =  ew^\  Vt  G  [0,6/e],  where  W[t)  is  given  by 
W(t)  =  Z\q](t)  +  0(eq) 

=  £(-l)i+VZ;(t)  +  49)  +  0(eq).  (4.40) 

j=i 
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Let  Y ( i )  be  defined  by 


y(i)  =  (-l)<?+1e%(i)  +  4<?).  (4.41) 


Let  Y ( i )  be  defined  by 

Y(t)  =  (-!)«+' t* ^  £  Z,(t)dt  +  Z^ 

=  (-1  )5+1e»|;Z,(T)  +  45).  (4.42) 

Let  V  ( i )  be  defined  by 

V(t)  =  Z,(t)  -  f Z,(T ).  (4.43) 

By  Lemma  4.8,  since  T*,(T)  =  0,  k  —  0, . . . ,  9— 2,  we  have  that  Zq(t  +  T)  =  Zg(t), 
Vi  >  0,  and  so 

f  -L-  T 

V(t  +  T)  =  Z,(t  +  T)-~r-Z,(T) 

=  f‘+T  Z,(T)dT  -  ~Z,(T)  -  Z,(T) 

=  l  Z,(r)dT  +  JT  Z,(T)iT  -  -Z,(T)  -  Z,(T) 

=  Z,(T)+J‘z,(a  +  T)dc-±Z,(T)-Z,(T) 

=  J‘  Zq(a)da  -  tz,{T) 

=  m 

where  we  set  a  =  r  —  T,  So  V (i)  is  periodic  in  i  and,  thus,  bounded  Vi.  Let  M 
be  a  constant  such  that  ||V(i)||  <  M,  Vi  G  [0,6/e].  Then,  by  (4.41),  (4.42)  and 
(4.43),  Vi  G  [0,6/e], 

lint)  -  ?(t)ll  =  ||(-l)«+1e5(Z,(<)  -  |z,(T))||  =  |£«|||V(()||  <  M\<?\  =  0(<?) 

(4.44) 
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So  by  (4.32),  (4.36),  (4.40),  (4.41),  (4.42),  (4.44)  and  the  triangle  inequality, 
\\W(t)  -  Z®(t) ||  =  || W(t)  -  (£(-l)l+letZi(t)  +  (-1  Y+le^Zq(T)  +  Z{0q))\\ 

i= 1  1 

=  II W(t)  -  (zW(t)  _  (-1  )<+h"zq(t)  +  (-iy*h^z,(T))\\ 
<  \\W(t)  -  ZW(«)||  +  ||K(t)  -  ?(t)|| 

=  0{eq),  VtG  [0,6/e].  (4.45) 

Since  Z^q\t)  G  S,  Vt  G  [0,6/e],  for  small  enough  e,  W(t)  G  S'.  Thus,  g(t)  = 
y(W(t))  G  Q  and  g^(t)  =  ^(^(t))  G  Q,  Vf  G  [0,6/e].  It  follows  from  the 
definition  of  d  (2.46)  and  (4.45)  that 

d(g(t),9M(t))  =  II W(t)  -  Z<«)(0 II  =  0(e»).  V*  €  [0,  fr/e]. 

Finally,  from  Lemma  4.8,  since  Zj(0)  =  0  and  Zi(t+T )  =  Zi(t),  i  =  1, . . . ,  q- 

1,  we  have  that  Z^NT)  =  Zt( 0)  =0,  i  =  1, . . . ,  q  -  1,  for  N  an  integer.  Thus, 

<?-l  NT  I  \ 

Z^(NT)  =  ly-iy+VZitJVT)  +  (-1)«+Ie«— -Z,(T)  +  zj’> 

i=  1  ^ 

=  (-l)9+ViVZg(T)  +  4?)  □ 

Let  Ip  be  the  ordered  list  of  indices  {ii, . . . ,  iv}  where  i„  G  {1, . . . ,  m},  v  = 
1, . . .  ,p.  We  define 

m  mm  m 

E  =  EE---E- 

Ip= 1  ii  =1 12=1  ip= 1 

Let 

tip(t)  =  J  Uh  (n){J0  1  ui2(T2)  ■■■(JQP  1  wip(Tp)drp) . . .  dr2)dT1. 

Then,  using  the  definition  of  high-order  structure  constants  (equation  (2.18)) 
associated  with  the  basis  {£i, . . .  ,£„}  for  Q, 

m 

Tt(t)  =  E  */.+.(*)[&  J  [^12  >  •  •  ■  fe/t)  ^4+1  ]...]]  (4.46) 

4+i=i 

n  m 

=  E  E  tik+At)rlIk+1Zi. 

1=1  /fc+i=l 
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In  the  next  theorem  and  remark  we  justify  the  name  Area-Moment  Rule. 


Theorem  4.12  For  q  >  2,  Zq(T )  of  Theorem  4.11  can  be  expressed  as 


1  T 

Z,(T)  =  -Jo  \U(T),T,.2(T)]dT. 


U{t)  =  f*  U(r)dr  and  Tg_2(i)  are  both  periodic  in  i  with  period  T.  Consequently, 
Zq(T )  has  the  following  geometric  interpretation.  Let  A u  X(T)  be  the  area 
bounded  by  the  closed  curve  described  by  iq(t)  and  </,_x(t)  from  t  —  0  to  t  =  T. 


Then, 


n  m  m 


y  p=i  t- 1  /„_i=i 


where  {i,Iq_i}  —  {i,  ii, . . .  and  j  are  depth-(g  —  1)  structure  con¬ 

stants  associated  with  the  basis  {£i, . . .  ,£n}  for  Q  defined  by  (2.18). 


Proof.  Since  in  Theorem  4.11  we  assumed  U(t  +  T)  =  U(t),  Vi  >  0  and  Tk(T)  — 
0,  k  =  0, . . . ,  q  —  2,  by  Lemma  4.8,  Zi(t  +  T)  =  Zi(t),  Vi  >  0,  *  =  1, . . . ,  q  —  1. 
Since  Z*( 0)  =  0,Vz,  then  Zi(T )  =  0,  i  =  l,...,q  —  1.  Thus,  the  only  nonzero 
term  in  the  expression  for  Zq(T)  ((2.43))  is  Tg_i(T)  and  so 

Z,(T)  =  ijV.CT) 

=  ijfVM.TWT)]*-.  (4.47) 

From  Lemma  4.8,  Tg_2(i  +  T)  =  Tg_2(i),  Vi  >  0.  Thus,  by  (4.46)  i/?-1(i  +  T)  = 
i/„_ i (i),  Vi  >  0.  Also,  U(t  +  T)  =  T0(i  +  T)  =  T0(i)  =  t/(i),  Vi  >  0  which  implies 
that  Ui(t  +  T)  =  fij(i),  Vi  >  0.  Therefore,  the  plane  curve  described  by  {q(i )  and 
i/,_i(i)  from  i  =  0  to  t  =  T  is  closed.  Recalling  that  ■Ui(i)  =  u;(i),  by  Green’s 
Theorem,  Ai/9_j(T)  =  /0rUj(r)i/9_1(r)dr.  From  (4.46)  and  (4.47)  we  have  that 

1  />T  m  m 

Zq{T)  =  ~  /  E«*(t)6,  1]  i4-i(T)[6i,[62>-'-[6,_2,69-i]---]]]dr 

y  •/0  i=i  4-i=i 
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i  m  m 

=  ~Y  Y  (/  •••]]] 

9  i=  1  4-1=1  -70 


-I  n  m  m 

=  -EEE 

y  P=l  *=1  /,-i=l 


□ 


Remark  4.13  Z^q\t)  of  Theorem  4.11  is  the  gth-order  average  approximation 
of  Z(t)  on  [0, 6/e].  Z^q\t)  is  the  sum  of  a  secular  term  (a  term  linear  in  t )  and  an 
0(e)  periodic  term.  The  secular  term  is  proportional  to  Zq(T)  which,  according  to 
Theorem  4.12,  is  proportional  to  the  areas  A uq_1  and  the  depth-(</  —  1)  structure 
constants  associated  with  {£i,...,£n}-  This  justifies  calling  Theorem  4.11  an 
area  rule.  Using  integration  by  parts,  we  can  derive  equivalent  expressions  for 
Zq(T)  that  lend  an  alternative  geometric  interpretation,  i.e., 

Z,(T)  =  l  [T{U(T),T,-2(T)]dT 
Q  JO 

=  [{U(T),\U(T),T,->(T)\}dT  (4.48) 

=  -( /Vw,  lU(r),T,.3(r)]]dr  +  f[V(T),  \U(t),  {U(t), Ts_4(r)]]]dr) 
q  Jo  Jo 


The  terms  in  these  expressions  will  be  proportional  to  moments  and  depth-  (q  —  1) 
structure  constants.  For  example,  the  last  term  in  the  last  expression  will  be  of 
the  form, 

/T[U(r),[C/(r),...[U(r),[U(r),U(r)]]...]]dr 

JO 

m  71 

=  Y(  «ii(r)^(r)-«i,-2(r)vi(r)s(r)rfr)Er/,4> 

b= i  J0  v= i 

where  the  term  in  parentheses  is  interpreted  as  a  moment.  Thus,  we  call  Theo¬ 
rem  4.11  an  area-moment  rule. 
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In  the  following  corollaries  we  illustrate  gth-order  averaging  for  q  —  1,2,3. 
For  alternative  proofs  of  these  corollaries  (under  more  restrictive  hypotheses)  see 
[43,  49,  47]. 

Corollary  4.14  (q  =  1)  Consider  system  (2.9).  Assume  U(t)  and  b  are  as  in 
Theorem  4.9  and  U(t  +  T)  =  U(t),  Vt  >  0.  Let  <?(0)  =  go  E  Q  C  G  and 
Z0  =  ^_1(^0)  =  0(e).  Define 

ZW(t)  =  eUavt  +  Z$\  gU(t)  =  ezWU,  (4.49) 

where  Uav  =  £/0T U(r)dT.  If  \\Z0  -  Z^\\  =  0(e)  and  Z^(t)  e  S,  Vt  e  [0 ,6/e] 
then, 

d(g(t),g{1](t))  =  0(e),  Vte  [0,6/e].  (4.50) 


Proof:  Since  Zi(t)  =  JqU(t)cIt,  by  (4.36), 

z(1)«  =  £lz,(T)  +  41) 

= 

—  eUavt  +  Zq  K 

The  corollary  follows  by  Theorem  4.11.  ^ 

Remark  4.15  Apart  from  the  different  treatment  of  the  initial  condition,  this 
first-order  approximation  of  g(t)  is  identical  to  that  derived  in  Theorem  4.1  using 
the  product  of  exponentials  representation. 


Corollary  4.16  (q  =  2)  Consider  system  (2.9).  Assume  U(t)  and  b  are  as  in 
Theorem  4.9  and  U(t  +  T)  =  U(t),  Vt  >  0.  Let  <?(0)  =  g0  G  Q  C  G  and  Z0  = 
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'L  Htfo)  =  0(e).  Let  Z ^  -  YX=izki\k  and  assume  that  \\Z0  -  Z^\\  -  0(e2). 
Let 

m 

zk](t)  =  euk(t )  +  e2  Y  “ijWij  +  ^o2)'  (4-51) 

Then, 

m 

z^(NT)  =  eNTuavk  +  e2N  Y  ^reaij(T)r^  +  zkf\  (N  an  integer)  (4.52) 

i,j=V,i<j 

r£.,  Area,ij(T),  a,ij(t )  are  defined  by  (2.15),  (2.22),  (2.23),  respectively.  Define 


Z[21W  =  E421W&,  «|21(<)=ez,!,“>.  (4.53) 

fc=l 

If  Z®(t)  es,vte  [0,6/e],  then 

d(g(t),g[2](t))  =  0(e2),  Vf  <E  [0,6/e].  (4.54) 

Suppose  that  Uav  =  0.  Define 

f  m 

42)(*)  =  €{ik(t)  +  e2-  Y  Areaij(T)rfj  +  zk(02),  (4.55) 

1  i,j-l;i<j 

Z(2)(t)  =  t^mk,  s'2>(0  =  eze)'‘».  (4.56) 

k=l 

If  ZM(t)  G  5, Vi  e  [0,6/e],  then 

d(g(t),g{2)(t))  =  0(e2),  Vt  G  [0,6/e].  (4.57) 

Further,  for  t  =  NT,  N  an  integer, 

m 

zf(JVT)  =  e2iV  ^  Areoa(r)r§  +  z*Si).  (4.58) 

i,j=l\i<j 


Proof:  From  (4.32)  of  Theorem  4.10 

Z®(t)  =  eZ1(t)  -  e2Z2(t)  +  Z[2]. 
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By  (2.45),  skew-symmetry  of  the  Lie  bracket  and  the  definition  of  Gy(t)  (2.23) 


2 2(t)  =  ^JQ[U{r),U(T)]dT 

I  pt  171  171 

=  9  / 

Z  1/0  i=l  7  =  1 


1  /‘t 

=  Eo  'Gi(7-)fij(r)[6,^']^ 

i,j=l  z  •'o 
m  1  /•* 

=  53  -  /  (ui(r)uj(r)  —  Uj(r)ui(r))dT[^i,  ^j] 

i,j=hi<j  Z  J0 


n  m 


-£(  E  «vWrfj)&- 

fc=l  ij=l;i<j 


(4.59) 


Thus,  since  Zi(i)  =  l/(t),  Z^(i)  and  5^(t)  as  defined  in  Theorem  4.10  reduce  to 
(4.51)  and  (4.53).  When  t  =  NT,  N  an  integer, 

rNT 


rly  1 

Zi(NT)  =  /  U(r)dr 

J  0 

rT  r2T  rNT 

=  /  C/(r)dr+  /  U(r)dr  +  . . .  +  /  I7(r)dr 
Jo  Jt  J(n-i)t 

=  [T  Ufa  dr  +  [T  Ufa  +  T)da  +  . . .  +  f  U(aN-  1  +  {N-l)T)daN_x 
Jo  Jo  Jo 

T 

=  N  j  U(t)  =  NTUav. 

Jo 


We  show  Z2(NT)  =  NZ2(T)  by  induction.  The  relation  holds  trivially  for  N  =  1. 
Suppose  Z2(MT)  =  MZ2(T)  for  M  an  integer.  We  need  to  show  that  Z2((M  + 
1)T)  =  (M  +  1)Z2(T). 

I  r(M+l)T  [Ti 

z2((m  +  1)T)  =  -  /  [Ufa),  /  ufa2)dT2]dn 

Z  Jo  Jo 

J  pMT  fT\  1  r{M+\)T  [T\ 

=  o  iUfa)>  /  Ufa)dr2]dTl  +  -  /  [Ufa),  Ufa)dT2\dri 
2  J  0  J  0  2  J  MT  J  0 

1  rT  ro\-\-MT 

=  Z2(MT )  +  -  /  \Ufai  +  MT),  /  Ufa)dr2]dax 

2  Jo  Jo 

1  rT  rMT  1  rT  rai+MT 

=  MZ,(T)  +  -  [(7(0-,),  /  U(T2)dr2]dai  +  -  [Uln),  U^d^do, 

Z  Jo  Jo  Z  Jo  J  MT 

=  MZ2(T)  +  l  fT[Ufa),  MTUav]do\  +  \  (T[Ufa),  riU(a2  +  MT)da2]dax 

Z  Jo  Z  Jo  Jo 
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=  MZ2(T)+1-M[[T[U(o1)dauTU„]  +  l  P[UM,  f‘ U(a2)da2]dal 
2  Jo  2  Jo  Jo 

=  MZ2(T)  +  ^M[TUav,TUav\  +  Z2(T) 

=  (M  +  1)Z2(T). 

Therefore,  Z2(NT )  =  NZ2(T)  by  induction  and  so 

Z® (NT)  =  eNTUav  ~  e2NZ2(T )  +  Z^ . 

From  (4.59), 

n  m 

Zi(T)  =  -E(  E  Oii(T)T<j)& 

k= 1 

n  m 

=  -E(  E  ^ea,,(T)r‘)&.  (4.60) 

k~l  i,j=l\i<j 

Thus,  (4.52)  follows.  (4.54)  follows  from  Theorem  4.10.  For  the  second  part  of 
the  corollary  we  note  that  by  (4.36)  and  (4.60)  in  Theorem  4.11, 

Z(2)W  =  eZiW  -  e2|z2(T)  +  Zf 

n  ±  m 

=  5Z(ewfc(t)  +  e2-  Y,  AreaijiT)^  +  Zk^k- 

k= 1  i,j=l;i<j 

Since  T0(T)  =  Uav  =  0,  the  assumptions  of  Theorem  4.11  are  satisfied.  (4.57) 
and  (4.58)  follow  from  Theorem  4.11.  D 

Remark  4.17  We  note  that  7 ^(t)  of  (4.9)  is  identical  to  z^\t)  of  (4.55).  Thus, 

(2)  (2) 

both  the  product  of  exponentials  ezi  ^  ■  ■  ■  eZn  and  the  single  exponential 

(2)  (2) 

e*i  (9£i+-«n  (t)U  provide  an  0(e2)  approximation  to  g(t). 


Corollary  4.18  (q  =  3)  Consider  system  (2.9).  Assume  U(t)  and  b  are  as  in 
Theorem  4.9  and  U(t  +  T)  =  U(t ),  Vt  >  0.  Let  g(0)  =  go  €  Q  C  G  and  Z0  = 
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'F  1  (<7o)  =  0(e2).  Let  Z (j3)  —  DJLX  zk^£k  and  assume  that  || Z0  -  Z^ ||  =  0(e3). 
Suppose  that  Uav  =  0  and  Area,ij(T)  =  0,  =  Define 

m  j.  m 

Zp\t)  =  €up(t)  +  x;  (e%'(t)r^-e3-^mijfc(T)^fc)+^3)(4.61) 

i,j=l-,i<j  k= 1 

m  j. 

=  eup(t)  +  (e2aij(t)r^j-e3-miji(T)e^ji- 

m 

E  (2mi^(T)  -  miti(T))(rijt)  +  z™.  (4.62) 

fc=2+l 

Zm(t)  =  ±zf\t%,  «<»>(«)=  ezl,,<».  (4.63) 

p= i 

Areaij(T),  a,ij(t),  rriijk(T)  are  defined  by  (2.16),  (2.22),  (2.23),  (2.26),  re¬ 
spectively.  If  Z(3)(t)  £  S,\/t  £  [0,  fc/e]  then, 

d(g(t),gW(t))=0(e3),  V(€[0  ,b/e],  (4.64) 

Further,  for  t  —  NT,  N  an  integer, 

m  m 

zf\NT)  =  -t*N  E  (mili(T)erji+  J2(2m,jk(T)-miki(T))S;jt)  +  zr^. 

i,j=l;i<j  fc=i+ 1 

(4.65) 


Proof :  By  (4.36)  of  Theorem  4.11, 

Z(3) (0  =  eZ.it)  -  e2Z2(t)  +  e3^Z3(T)  +  Z J3). 

Zi(t)  =  U(t)  and  Z2{t)  is  given  by  (4.59).  Uav  =  0  implies  T0(T)  =  0.  By  (4.60) 
Area,ij(T)  =  0,  Vi,j  —  l,...,n,  implies  T.(T)  =  2 Z2(T)  =  0  ,  as  needed  for 
Theorem  4.11.  By  (4.48)  of  Remark  4.13,  skew-symmetry  of  the  Lie  bracket  and 
the  definition  of  rriijk(T)  (2.26), 

Z3(T)  =  -\[{U(T),[U(T),U(T))]dT 
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=  -\j0  [[ U(T),U(T)],U(r)]dT 

1  rT  mm  m 

=  -Q  /  E  fi»(r)6»  5Z  Mj(TX?],  5Z  Uk(T)tk]dT 
J  -70  i=l  j=l  fc=l 

m  ]_  /-T 

=  -  E  o  /  ^(r)Mj(r)“fc(r)[[6,^],6]^ 

m  m  y  rT 

=  -  E  Eo  /  (^(T)«i(r)-«i(r)«i(r))«fc(T)dr[[6,^],^fc]dr 

fc=l  3  •/° 
n  m  m 

=  -£  £  T,^m(T)eUp- 

p=l  fc=l 


From  equations  (2.17)  and  (2.29)  (skew  symmetry  of  Lie  bracket  and  Jacobi 
identity) , 


=  «Sy  -  «S».  "WO  =  m^fT)  -  m^T). 


So, 


mijk(T)9ijk  +  rriikj{T)6vik^  +  rrijkl(T)9pkl 
—  mijk(T)9ijk  +  rnikj (T) 9plk-  4-  +(mjfcj(T)  —  rriijk(T))(9pkj  —  9Pjk) 

=  (2 mijk  ( T )  -  mikj  (T) ) 9pijk  +  (2mikj  (T)  -  miifc  (T) ) 0ffcj . 

As  a  result,  we  can  eliminate  nijki(T)9pki  from  our  sum  as  follows: 

mm  m  m 

£  £  rnijk(T)!?ijk  =  £  (m^T)^  +  £  (2 mijk(T)  - 

k=li,j=l;i<j  i,j=l;i<j  k=i+ 1 

Thus,  Z^\t)  is  given  by  (4.61)  -  (4.63).  (4.64)  and  (4.65)  follow  from  Theo¬ 
rem  4.11. 

□ 


Remark  4.19  The  formulas  in  the  theorems  and  corollaries  of  this  section  are 
clearly  basis-independent. 
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4.3  Curvature  Form 


In  this  section  we  show  that  the  secular  term  in  the  area  rule  of  Corollary  4.16 
derives  from  the  curvature  form  of  a  certain  principal  fiber  bundle  with  connec¬ 
tion.  The  purpose  of  this  derivation  is  to  emphasize  that  the  formulas  in  our 
averaging  theory  are  basis-independent.  In  Section  4.3.1  we  define  principal  fiber 
bundles,  connections  and  curvature  forms.  In  Section  4.3.2  we  discuss  a  particu¬ 
lar  principal  bundle  with  connection  and  derive  the  secular  term  of  (t)  from 
the  associated  curvature  form. 

4.3.1  Principal  Fiber  Bundles  and  Connections 

Principal  fiber  bundles,  connections  and  curvature  forms  are  defined  in  this  sec¬ 
tion.  Nomizu  [62]  and  Bleeker  [8]  are  our  main  references.  In  these  references, 
definitions  are  made  with  respect  to  right  actions  of  the  structure  group  on  the 
total  space  whereas  we  give  definitions  based  on  left  actions.  We  follow  Yang  [79] 
for  these  definitions. 

A  principal  fiber  bundle  is  denoted  by  V  =  ( Q,B,ir,G ).  Q  and  B,  smooth 
manifolds,  are  the  total  space  and  base  space ,  respectively.  G,  a  Lie  group,  is  the 
structure  group.  V  satisfies  the  following  conditions: 

(a)  There  is  a  (smooth)  left  action  $  of  G  on  Q  as  defined  by  (2.2).  Further,  $ 

is  a  free  action,  i.e.,  if  $(g,  q)  —  q,  q  6  Q,  then  g  =  e  e  G. 

(b)  B  =  Q/G  and  n  :  Q  — >  B  is  the  canonical  projection  map  and  is  differen¬ 

tiable. 

(c)  Q  is  locally  trivial.  This  means  that  for  each  x  G  B  there  is  a  neighborhood 

W  of  x  such  that  7 r-1(IF)  C  Q  is  isomorphic  to  W  x  G.  The  map  q  € 
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7r-1(W)  (7r(g),  </>(g))  C  W  x  G  is  a  diffeomorphism  where  (j) :  tt-1^)  -» 

G  satisfies  4>(g  ■  q)  =  gfi{q))  Vg  £  G.  This  diffeomorphism,  denoted  by  <^r, 
is  called  a  local  trivialization. 

For  a;  £  B,  7r_1(:r)  is  the  fiber  over  x  and  is  isomorphic  to  G.  For  q  £  Q,  the 
fiber  through  q  is  the  fiber  over  x  —  tt (q).  If  Q  —  BxG  then  Q  is  a  trivial  principal 
fiber  bundle.  In  this  case,  the  diffeomorphism  fix  of  (c)  above  is  called  a  global 
trivialization.  For  a  trivial  bundle  the  action  of  G  on  Q  is  $(g,  ( x ,  h))  =  ( x,gh ) 
for  x  £  J3,  g,h  £  G. 

We  define  a  local  section  of  V  to  be  a  map  a  :  W  C  B  — >■  Q,  where  W  is  open 
in  B,  such  that  tt  o  a  is  the  identity  on  B,  i.e.,  ir  o  a(x)  =  x.  If  W  =  B  then  a  is 
called  a  global  section.  There  is  a  natural  correspondence  between  local  (global) 
trivializations  and  local  (global)  sections.  For  instance,  in  the  case  of  a  trivial 
bundle,  given  a  define  (j)T(ga(x))  =  ( x,g ).  Given  define  a(x)  —  ^l(x,e). 

Let  V  be  an  r-dimensional  vector  space  with  basis  Vi,...,vr.  Let  A k(Q)  be 
the  space  of  real-valued  A;-forms  on  Q.  Let  fii, . . . ,  fir  £  A k{Q).  Then,  Yh=i  fiivi 
is  a  V -valued  k-form.  We  denote  A fc(Q;  V)  as  the  space  of  V-valued  /c-forms  on 
Q.  Let  X(Q)  denote  the  space  of  vector  fields  on  Q. 

There  are  at  least  three  (equivalent)  ways  to  define  a  connection  on  a  principal 
fiber  bundle.  We  give  the  definition  most  useful  for  our  purposes.  Let  Q  be  the 
Lie  algebra  of  G.  A  connection  form  on  a  principal  fiber  bundle  V  =  ( Q ,  B,  n,  G) 
is  a  ^-valued  1-form  on  Q,  lo  £  A1(Q;  G),  such  that 

(1  )w(fo(g))  =  & 

(2)  ((*s)'w)(y)  =  Ad^(V),  Y  £  X(Q). 
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£ q{q )  is  defined  by  (2.4),  Ad  is  defined  by  (2.3)  and  ($5)*  is  the  dual  of  ($9)*  = 
T<f>5,  the  differential  map  of 

The  connection  on  V  defines  a  splitting  of  TqQ,  the  tangent  space  to  Q  at  q  G 
Q.  To  each  point  q  G  Q,  the  connection  assigns  a  horizontal  subspace  Hq  C  TqQ 
which  together  with  the  vertical  subspace  defined  by  Vq  =  {v  G  TqQ  \  Tr:(v)  =  0} 
satisfies 


(a)  TqQ  =  Hq®  Vq, 

(b)  TqQg  •  Hq  =  Hg.q,  Vg  £  G,  q  G  Q. 

(c)  Hq  depends  differentiably  on  q. 

A  selection  of  a  connection  form  u  that  satisfies  (1)  and  (2)  above  is  equivalent 
to  a  unique  splitting  of  TqQ,  Vq  €  Q ,  where  Hq  =  Ker(cj(^)),  Vq  G  Q  and  Ker 
stands  for  kernel.  Let  Y  G  X(Q),  then  we  can  write  for  any  q  G  Q 

Y(q)  =  Yv(q)  +  Yk(q),  Y”(q)  £  V„  Yh(q)  E  H,. 

We  can  then  define  smooth  vector  fields  Yv  and  Yh  such  that  Yv  maps  q\-^-Yv  ( q ) 
and  Yh  maps  q  i-»  Yh(q).  We  say  that  Yv  and  Yh  are  the  vertical  component  of 
Y  and  the  horizontal  component  of  Y,  respectively. 

Let  u>  G  A k(Q]  Q).  The  covariant  derivative  of  to,  Duo  G  Afc+1(Q;  Q),  is  defined 
by 

Du{Y0 ,  ...,n)  =  dco(Y0h, Ykh),  Yi  G  X(Q). 

The  curvature  form  T  G  A 2(Q',Q)  of  the  connection  where  to  G  A1(Q;Q)  is  the 
connection  form  is  defined  by 

T  =  Dev.  (4.66) 
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The  connection  form  and  its  corresponding  curvature  form  have  the  following 
three  important  properties  for  Yi,Y2  E  A(Q): 

(($9)T)(r1,y2)  =  Ad9r(r1,r2). 

r(Fby2)  =  du(YuY2)  +  [uWMYi)]-  (4-67) 

T(Y1,Y2)  =  -u;([Ylh,Y2h}). 

A  smooth  curve  q(-)  =  {q(t),  t  E  [0, 1]}  C  Q  is  a  horizontal  curve  if  dq(t)/dt  E 
Hq{t)i  Vt  £  [0, 1].  Let  x(-)  =  {x(t),  t  E  [0, 1]}  C  B  be  a  piecewise  smooth  curve. 
A  horizontal  curve  q(-)  is  a  horizontal  lift  of  x(-)  if  7T (q(t))  =  x(t ),  Vt  €  [0, 1].  An 
important  theorem  (c.f.  [62])  states  that  given  x(-)  and  q0  E  Q  where  7r(</0)  = 
x(0),  there  is  a  unique  horizontal  lift  q(-)  which  starts  at  g(0)  =  q0-  The  map 
:  qo  —  q{ 0)  ►->  qi  =  q(  1)  is  called  the  parallel  displacement  and  is  a  differentiable 
isomorphism  of  the  fiber  through  q( 0)  onto  the  fiber  through  q(  1).  Consider  x(-) 
where  x(0)  =  x(l)  =  Xo,  then  the  parallel  displacement  is  an  automorphism  of 
7T_1(x0).  'I'zo  is  the  set  of  all  such  automorphisms  and  forms  a  group  called  the 
holonomy  group  at  xo-  An  element  of  ^Xo  is  called  the  holonomy  at  x0. 

Let  x(-)  C  W  C  B,  W  open,  be  a  closed  curve,  i.e.,  x(0)  =  x(l)  =  Xo-  Let 
qo  E  7r_1(x0)  C  Q.  Let  a  :  W  — >  Q  be  a  local  section  of  the  bundle.  Then 
cr(x(-))  is  a  curve  in  Q.  Let  u>  E  A  1{Q\Q)  define  the  connection,  and  let  q(-)  be 
the  horizontal  lift  of  x(-)  with  g(0)  =  q0.  Let  g(- )  =  {g{t),  t  E  [0,1]}  C  G  be 
defined  such  that  q(t)  =  <&(g(t),  a(x(t))),  Vt  E  [0, 1].  Then  g(t)  is  the  solution  of 
the  following  differential  equation  on  G  [79]: 

-  =  —TeLg(a*u)(x(t)).  (4.68) 

We  say  that  g(l)  is  the  holonomy  at  q0  with  respect  to  x(-) 
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Remark  4.20  Equation  (4.68)  is  a  left-invariant  system  on  the  Lie  group  G  of 
the  form  (2.9)  since  —(cr*u)(x(t))  is  a  curve  in  Q.  Accordingly,  the  averaging  the¬ 
ory  of  this  chapter  provides  an  average  approximation  of  the  holonomy,  i.e.,  of  the 
solution  g(t)  to  (4.68).  For  control  problems  we  interpret  x  as  our  periodically, 
time- varying  control  input  and  g(t )  as  the  resulting  drift  of  the  system.  For  exam¬ 
ple,  recall  the  spacecraft  with  an  appended  point  mass  oscillator  of  Section  3.1.2. 
In  this  example  the  control  input  is  the  velocity  of  the  oscillator  51  e  R3.  The 
configuration  space  of  the  rigid  part  of  the  spacecraft  is  G  —  50  ( 3).  We  can  de¬ 
scribe  this  system  by  the  principal  fiber  bundle  (5ft3  x  50(3),  5ft3,  %,  50(3))  with 
a  (mechanical)  connection.  For  this  bundle  5ft3  is  the  base  space  and  5ft3  x  50(3) 
the  total  space.  Then  the  spacecraft  angular  velocity  given  by  (3.8)  can  be 
derived  from  0  =  —  (cr*w)(y(t))  and  the  holonomy  equation  (4.68)  is  X  =  XQ, 
X(t)  G  50(3).  In  the  next  section  we  consider  a  principal  fiber  bundle  with  con¬ 
nection  where  the  control  input  x  is  given  by  x  =  U(t)  G  Q  and  U(t)  =  ~(a*co)(x). 
In  this  case,  (4.68)  specializes  to  (2.9). 

4.3.2  Curvature  Form  and  Area  Rule 

The  tangent  bundle  TG  of  a  Lie  group  G  is  trivially  a  vector  bundle,  i.e.,  TG  ~ 
G  x  £/,  where  the  global  trivialization  is  given  by 

TG  — >  G  x  Q,  (g,  vg)  i— >  ( g ,  (TeLg)  1us). 

One  may  also  view  this  as  the  trivial  principal  fiber  bundle  V  =  ( Q ,  B,  ir,  G)  = 
( Q  x  G,  Q,  7r,  G).  The  action  of  G  on  Q  =  Q  x  G  is  defined  by 

<3 >  \  G  x  Q  x  G  Q  x  G,  $(g,  ( x ,  h ))  =  (x,  gh). 
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The  projection  map  ir  is  defined  by 


7 r  :  G  x  G  ^  G,  tv(x,  h)  =  x. 

The  fiber  over  x  G  G  is  7r-1(:c)  =  (x,h),  h  G  G,  and  the  fiber  through  (x,g)  G 
Q  x  G  is  (x,  h),  h  6  G,  which  is  isomorphic  to  G. 

Now  consider  a  closed  curve  x(-)  =  {x(t),  t  G  [0,T]}  C  Q  and  a  point 
<7o  €  7T~ 1  (x(0))  C  G  xG.  Since  V  is  a  trivial  bundle,  we  consider  a  global  section, 
a  :  Q  ^  G  x  G  defined  by  a(y)  —  (y,e),  y  G  G,  e  G  G.  Let  oj  G  hl(Q\G) 
be  the  connection  form  for  a  connection  on  V.  Then  to  :  T(G  x  G)  G  and 
cr*u) :  TG  — >  G ■  By  (4.68)  the  holonomy  at  q0  with  respect  to  £(•)  is  the  solution 
of  the  following  equation  at  t  =  T: 

9  =  -TeLg(a*co)(x(t)).  (4.69) 

Suppose  we  let  o*lo  be  defined  by  (cr*uj)x  =  -dx,  i.e., 

<j*uj  -.TG-^G,  &M0  =  (4-70) 

Then, 

g  =  TeLg  •  x.  (4.71) 

The  selection  of  a*u  uniquely  defines  the  connection  form  uj,  which  must  have 
the  form  [57]: 

W(x,9)  =  TgR~xdg  -  kdgdx 

=  TgRgXdg  -  TgR~lTeLgdx 
=  TgR~1(dg  —  TeLgdx).  (4.72) 

This  can  be  confirmed  by  recalling  from  Section  4.3.1  that  horizontal  curves  must 
be  in  the  kernel  of  u>(x,g)-  The  kernel  of  W(Xj9)  given  by  (4.72)  is  defined  by  (4.71). 
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Further,  we  can  show  that  o>(Iifl)  is  a  valid  connection  form,  i.e.,  that  it  satisfies 
(1)  and  (2)  of  the  definition  of  a  connection  form  in  Section  4.3.1.  First,  we  have 
that  for  q  =  (x,g)  e  Q  x  G,  £  G  G, 

Cq(q)  = 


So, 

TeRg  ‘  0  — 

This  confirms  that  u)(x>g)  satisfies  (1).  Secondly,  for  g\  G  G  and  Y  G  X(Q),  we 
have  that 

(^ffi )  —  w^sl(x,3)((^si)*F") 

=  W(a:,9i9)((<^>9l)*^) 

=  (TaigRgigdidig)  -  ^gigdx){(^gi),Y) 

~  (Tgig(Rgi  Rg  )(TgLgi)dg  —  Te(RgigLgig)dx)(($gi)*Y) 

=  (Tg (i?“ 1  R~ 1  Lgi ) dg  -  Te (R~* R~lLgiLg)dx){{^gi)ifY) 

=  (Rg  (Rgi  Lgi  Rg  x)dg  -  Te(R-1LgiR;1Lg)dx)((%1).Y) 

=  (Te(R-^Lgi)(TgRgl)dg  -  Te(R;i1L9l)Te(R;1Lg)dx)(^9l),Y) 


d 

dt 

t= 0 

d 

dt 

t= 0 

(0, 

d 

dt 

mi 


^(exp  (t£),q) 

(x,  exp (t£)g) 

(Rg  exp  (££))) 

exp  (tO ) 


t= o 


t=o 


(0  ,TeR,-{). 


{( TgRg  1dg  -  Adgdx),  (0 ,TeRg  ■  £)) 
-Ad gdx  ■  0  +  (TgR~l)(TeRg  ■  f) 


e- 
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=  M^R^dg  -  Ad,dx)((%,),Y) 

—  Ad5lW(Tj(;) (($9l )*}  ). 

This  confirms  that  u)(x,g)  satisfies  (2). 

We  note  that  the  differential  map  of  our  chosen  global  section  is 

<7.(0  =  (£,0),  ZeTg  =  g,oeTG. 

So  we  can  verify  that 

<7*(0  =W(<7*(0)  =W((00))  =  ~C 

Similarly,  we  can  compute  the  pullback  of  the  curvature  form  rfory,zeT(?  =  C/ 
as 

r  *(y,  z)  =  r(a*y,  o.z)  =  r((y,  o),  (z,  o)).  (4.73) 

Based  on  our  definition  of  connection  form,  the  tangent  vectors  (y,  0),(z,  0)  G 
Tg  x  TG  can  be  expressed  as  the  sum  of  horizontal  and  vertical  components,  i.e., 

(y,  0)  =  (y,  of  +  (y,  Of  =  (y,  TeLgy )  +  (0,  -TeLgy), 

{z,  0)  =  (z,  Of  +  (z,  Of  =  (z,  TeLgz )  +  (0,  -TeLgz), 

Thus,  using  the  third  identity  of  (4.67)  we  get 

T((y,0),(z,0))  =  —w([(y,0)h,  (z,  Of]) 

=  -w([(y,  TeLgy ),  (z,  TeLgz)}) 

=  ~w(([y,  z],  [TeLgy,  TeLgz ])) 

=  -u(([y,z],TeLg[[y,z]])).  (4.74) 

Here  we  used  the  notation  [[•,  •]]  for  the  Lie  bracket  on  g  to  distinguish  it  from 
the  Lie  bracket  of  vector  fields.  We  can  express  the  vector  field 

Y  ±  ([y,z],TeLg[\y,z]])  GTS  xTG 
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as  the  sum  of  horizontal  and  vertical  components, 


Y  —  Yh  +  Yv  =  ([y,  z\,TeLg[y,  z})  +  (0,  TeLg[[y,  z]]  -  TeLg[y,  z}). 

By  definition,  co(Yh)  =  0.  So 

-u{([y,z],TeLg[[y,z]]))  =  -w((0 ,TeLg[[y,  z]\  -  TeLg[y,  z})) 

=  ~(TgR-ldg  -  Adgdx)(0,TeLg[[y,z}]  -  TeLg[y,z ]) 

=  -TgR^TeLg(nz]]-[y,z]). 

When  evaluated  at  g  =  e, 

-u{([y,z],TeLg[[y,z}]))  =  ~[[y,z ]]  +  [y,z].  (4.75) 

Thus,  by  (4.73)  -  (4.75) 

r  *(y,z)  =  ~[[y,z]]  +  [y,z\.  (4.76) 

Now  let  U(t)  —  i  Ui(t)£i  G  Q  ( um+i  —  —  un  =  0,  m  <  n)  be  a  piecewise 

continuous  curve  with  U(t  +  T)  =  U(t),  Vt  >  0  and  Uav  =  0  (defined  by  (2.21)). 
Let  U(t)  —  J2i= i  where  u*  are  defined  by  (2.20)  and  {£i, . . . ,  ^n}  is  a  basis 

for  Q.  Then  U(t  +  T)  =  U(t),  Vt  >  0  and  U  =  U.  Let  x(t)  =  eU(t)  e  Q,  then 
(4.69)  and  (4.71)  become,  respectively, 

9  =  -TeLg{<j*u){eU{t)),  (4.77) 

^  =  eTeLg-U(t).  (4.78) 

Equation  (4.78)  is  our  main  system  of  interest  on  the  Lie  group  G,  i.e. ,  it  is 
identical  to  (2.9). 


95 


Proposition  4.21  Let  C  be  the  closed  curve  in  Q  traced  out  by  eu(t)  from  t  =  0 
to  t  =  T.  Let  D  be  a  surface  in  Q  bounded  by  the  curve  C.  Then 

n  m 

°'r  =  -Z  £  Areatj(T)r^t, 

D  k=  1  i,j=l;i<j 

where  T  is  the  curvature  form  associated  with  the  connection  form  u>  defined  by 
(4.72). 

Proof.  Let  y  be  the  parametrization  defined  by 

\i\  A  C  3ft2  -4  D  cQ 

(x,y)  i-4  (eui, . . .  ,eun). 


Then, 


JLa‘r  =  Jiy°'r 


=  [[  a*r(du  o  da  o  ^-)dx  A  dy 

JJ  a  ox  dy 

- 


)dx  A  dy. 


(4.79) 


By  (4.76) 


a(£)  ayu)  _  am  a(0)  eyu)  eyu) 

dx  ’  dy  dx  dy  dx  ’  dy 

ud(eU)  d(eU) 

LL  dx  '  dy  JJ’ 


(4.80) 


since  coordinate  vectors  commute.  So  substituting  (4.80)  into  (4.79)  we  get 

I"  ■  -If- 

A  o  ff  ddidui  ,  .  ,  _  „  , 
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where  we  returned  to  the  notation  [•,  •]  for  the  Lie  bracket  on  Q  and  we  used  the 
fact  that  =  —[£/,&].  Let  Cij  be  the  closed  curve  described  by  u^t)  and 

iij(t),  t  =  0  to  t  =  T.  Let  Aij  be  the  area  bounded  by  C^.  We  have 


dui  A  dv,j 


II 


,du{  ,  dui  .  ,  ,duj  ,  du.j  ,  . 

■ ~dx  +  dy  A  — Ux  +  dy 

a  dx  dy  ox  dy 

rr  duidu^  _ 

JJa  dx  dy 


duj  dUi , 

—  -  -)dx  A  dy. 


dx  dy 


(4.82) 


From  (2.22) 


1  f1 

Areaij (T)  =  2  7o  (“*(<7)“t(cr)  _  Uj(o)ui(o))dc 

=  ( Uidtij  -  Ujdul) 

=  —  JJ  (dui  A  duj  —  duj  A  dui) 


=  £ 


dui  A  dui 


(4.83) 


So  using  (4.81)  -  (4.83),  we  have 


//  o*T  =  -  e2  [[  dui  A  duj  [&,  £,■] 

JJD  JJAH 


E  e24reaij(T)[&,$] 


n  m 


=  -E  £  ^reai,(T)r‘=.&, 

i,j=l;i<j 


since  Areaij(T)  =  0  if  i  >  m  or  j  >  m. 


(4.84) 


□ 


Remark  4.22  From  Corollary  4.16  g^(t)  =  ez(2)^  and  (t)  =  eU(t)  + 
T  EL  1  E™j=i;«<i  e2 Areaij (T) +  42)-  By  Proposition  4.21, 

ZW{t)=eU{t)-tjJD0*T  +  Z$). 
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4.4  Stability 


In  addition  to  providing  approximate  solutions  to  certain  systems  of  differential 
equations,  classical  averaging  theory  can  also  be  used  to  determine  the  stability 
of  system  equilibria.  In  this  section  we  illustrate  how  to  use  the  averaging  theory 
on  Lie  groups  derived  in  this  chapter  for  stabilization  of  equilibria  in  systems  on 
Lie  groups  of  the  form  (2.9).  We  do  so  using  classical  averaging  theory  and  the 
product  of  exponentials  representation  of  solutions  to  (2.9)  as  in  Section  4.1. 

According  to  Lemma  2.3,  g(t)  —  e7i  )(<^1  •  •  •  e7”  is  a  local  representation 
of  the  solution  to  (2.9)  on  the  n-dimensional  Lie  group  G  with  Lie  algebra  Q. 
The  parameters  q(t)  =  (71  (t), . . .  ,7 n(f))T  G  $ n  satisfy 

7  =  eM(^)u(t).  (4.85) 

To  determine  the  stability  of  equilibria  of  system  (2.9)  we  determine  the  stability 
of  equilibria  of  system  (4.85)  using  classical  averaging  theory.  However,  since 
(4.85)  provides  a  valid  representation  of  the  local  solution  so  long  as  M{ 7)  is 
nonsingular  (see  proof  of  Lemma  2.3),  the  right  hand  side  of  equation  (4.85)  is 
zero  only  when  u(t)  =  0.  Thus,  a  nontrivial  discussion  of  equilibria  of  (4.85) 
requires  that  we  introduce  feedback  into  our  system. 

Consider  equation  (2.9)  and  suppose  that  u  =  u(t,g),  and  u(t  +  T,g)  — 
u(t,g),  Vi  >  0.  Then  (2.9)  becomes 

m 

9  =  zTeLg  ■ U(t,g ),  U (i,  g)  =  Y,  w*(^ #)&,  m  <  n,  (4.86) 

i= 1 

where  g(t)  €  G  and  U(t,g)  6  Q.  Assuming  that  g(t)  €  Q  during  the  time  interval 
of  interest,  then  7 (t)  =  ^“^^(i))  is  well-defined.  So  we  can  write  u  =  u(t,  7)  = 
u(t,  ^(7)),  and  equation  (4.85)  becomes 

7  =  eM(j)u(t,  7).  (4.87) 
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We  note  that  the  nonautonomous  vector  field  on  G,  defined  by  (4.86)  is  no  longer 
left-invariant  in  general.  This  is  a  consequence  of  unrestricted  feedback. 

Following  Theorem  4.1  the  first-order  average  approximation  of  7 (t)  is  7 ^(t) 
defined  by 

1  T 

7^  =  eM(-y^)  —  [  u(r,  7(1))dr.  (4.88) 

1  Jo 

If,  for  example,  7*  €  S  and  u(t,  7*)  =0,  Vt  >  0,  then  7*  is  an  equilibrium  point 
of  both  (4.87)  and  (4.88)  Vt  >  0.  As  shown  in  the  theorem  that  follows,  we  can 
use  averaging  theory  to  draw  conclusions  about  the  local  stability  properties  of 
(4.87)  based  on  the  stability  properties  of  (4.88).  Additionally,  the  existence  of 
an  exponentially  stable  equilibrium  point  for  the  averaged  system  (4.88)  makes 
it  possible  to  extend  the  approximations  of  Theorem  4.1  from  an  0(l/e)  time 
interval  to  an  infinite  time  interval. 

Theorem  4.23  (First-Order  Averaging  Extended)  Consider  system 
(4.86).  Let  D  =  {7  €  5R"  |  ||7||  <  r}  C  S.  Assume  that  u(t,  7)  is  periodic  in 
t  with  period  T  and  suppose  that  M(j)u(t,  7)  is  continuous  and  bounded  with 
continuous  and  bounded  derivatives  up  to  second  order  with  respect  to  both  its 
arguments  for  (t,  7)  €  [0,oo)  x  D.  Suppose  that  <7(0)  =  #0  £  Q-  Let  7 (t)  be  the 
solution  to  (4.87)  with  7(0)  =  70  =  1F-1((7o)-  Let  7 ^(t)  be  the  solution  to  (4.88) 
with  7^(0)  =  70^  G  D.  Define 

gW(t)  =  e7‘1)(t)?1  •••e7")(t)?". 

If  7 *  e  D  is  an  exponentially  stable  equilibrium  point  for  (4.88)  then  3p  >  0  such 
that  if  H7015  -  7*11  <  P  and  ll7o  -  70^  II  =  0(e),  then 

d(g(t),g{1)(t))  =  0(e) ,  Vt  <E  [0, 00). 
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Further,  3e*  such  that  for  all  0  <  e  <  e*,  (4.87)  has  a  unique  exponentially 
stable  periodic  solution  of  period  T  in  an  0(e)  neighborhood  of  7*.  Similarly, 
(4.86)  has  a  unique  exponentially  stable  periodic  solution  of  period  T  in  an  0(e) 
neighborhood  of  g*  =  ^(7*)  E  Q. 

Proof.  By  classical  averaging  theory  (Theorem  7.4  of  [32]), 

II7W  -7(1)WII  =  0(e),  Vi  6  [0, 00), 

and  3e*  such  that  for  all  0  <  e  <  e*,  (4.87)  has  a  unique  exponentially  stable 
periodic  solution  of  period  T  in  an  0(e)  neighborhood  of  7*. 

Since  70,7*  E  D  and  7*  is  an  exponentially  stable  equilibrium  of  (4.88), 
7 M(t)  E  D,  Vi  >  0.  For  small  enough  e  this  implies  that  7 (t)  E  D,  Vi  >  0. 
Thus,  by  Lemma  2.3, 

g(t)  =  e71^1  •  •  ■e1n^n  =  ^(7^)),  Vi  >  0. 

Define 

g^(t)  =  e7i ..■e7"^n  =  W(7^(i)),  Vi  >  0. 

Then  by  definition  of  d 

d(g(t),g{1)(t))  =  ||7(i)  -7(1)(i)||  =  O(e),  Vi  e  [0,oo). 

Let  0  <  e  <  e*  and  let  7 p(t)  be  the  unique  exponentially  stable  periodic  solution 
of  period  T  in  the  O(e)  neighborhood  Nt  C  D  of  7*.  Let  gp(t)  =  4/(7 p(t)),  Vi  >  0. 
Let  g*  —  4r(7*)  and  let  ^(Ne)  =  {4i(x)  |  x  E  Ne}  C  Q.  Then  gp(t)  is  a  unique 
exponentially  stable  periodic  solution  of  period  T  in  the  0(e)  neighborhood  4i( Ne ) 
of  g*.  □ 
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As  an  example  consider  the  case  G  =  SO{ 3)  for  the  attitude  control  prob¬ 
lem  described  in  Section  3.1.  We  recall  that  7  =  (7i,72j73)t  corresponds  to  a 
type  of  Euler  angles.  We  suppose  that  we  can  measure  7.  Choose  Ui(t,  7)  = 
-2fcj7jsin2f,  hi  >  0  for  i  =  1,2,3.  Since  u(t,  0)  =  0,  Vf,  then  7*  =  0  is  an 
equilibrium  point  of  (4.87)  and  (4.88).  Also,  T  =  tt  and 


1. 

7 r 


u(t,  7 ^)dr 


=  i(— 2^7^)  /  sin2rdr 

7T  JO 

-  —^i7i1)- 


So,  from  (3.4)  and  (4.88)  we  see  that 


7i1} 

esec72^(— /ci7i^  cos 7^  +  k^y^  sin 7^) 

721} 

= 

e(— &i7i1}  sin  7^  -  k^  cos  7^) 

.  #  . 

e((tan721))(/c17|1)  cos  7^  -  k2y2)  sin  7^)  - 

and 


=  ^(7(1)) 


—ek\  0  0 

0  —  ek2  0 

0  0  — ek3 

Thus,  by  Lyapunov’s  indirect  method  since  ki  >  0,  Vi,  7*  =  0  is  an  exponentially 
stable  equilibrium  point  for  (4.88).  From  Theorem  4.23,  we  can  conclude  that 
(4.87)  has  a  unique  exponentially  stable  periodic  solution  in  an  0(e)  neighborhood 
of  7*  =  0  and  so  (4.86)  has  a  unique  exponentially  stable  periodic  solution  in 
an  0(e)  neighborhood  of  g*  =  4/(0)  =  I.  However,  since  7*  =  0  is  itself  an 
equilibrium  point  for  (4.87),  the  unique  exponentially  stable  periodic  solution 
about  7*  =  0  must  be  the  trivial  solution  7*  =  0.  Thus,  7*  =  0  is  an  exponentially 
stable  equilibrium  point  for  (4.87)  and  similarly  g*  =  I  is  an  exponentially  stable 
equilibrium  point  for  (4.86). 


dH 


cbyl1) 


7(i)=o 
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Chapter  5 


Constructive  Controllability  and  an 
Algorithm  for  Control 


In  this  chapter  we  address  the  second  main  objective  of  this  dissertation:  to 
synthesize  controls  for  systems  on  Lie  groups  of  the  form  (2.9).  In  the  previous 
chapter  we  addressed  the  first  main  objective:  to  describe  the  solution  (motion)  of 
system  (2.9)  on  the  Lie  group  G  given  periodically  time-varying  control  inputs. 
We  did  so  by  deriving  average  approximations  for  the  solution  to  (2.9)  on  G. 
Further,  we  developed  a  geometric  interpretation  for  the  average  formulas.  In 
this  chapter  we  use  the  average  formulas  and  exploit  the  geometric  interpretation 
to  derive  a  systematic  way  of  synthesizing  (periodically  time- varying)  controls  to 
achieve  desired  motion  on  G. 

The  motion  control  problem  that  we  consider  is  the  complete  constructive 
controllability  problem  (P)  stated  in  Section  2.1.3  for  drift-free  systems  of  the 
form  (2.9).  This  problem  amounts  to  one  in  which,  given  gi,gj  G  G,  tf  >  0,  we 
must  specify  control  u(t)  =  (ui(f), . . . ,  um(t)),  t  G  [0,  tf],  such  that  #(0)  =  gi  and 
g(tf)  =  gj,  where  g(t)  is  the  solution  to  (2.9).  This  is  a  “point-to-point”  control 
problem.  To  follow  a  certain  path  in  G,  e.g.,  to  avoid  obstacles,  we  could  choose 
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target  points  along  the  trajectory  and  then  do  point-to-point  control  repeatedly 
from  each  target  point  to  the  next. 

The  strategy  that  we  propose  for  solving  (P)  uses  open-loop  control  and 
intermittent  feedback  control.  This  strategy  allows  us  to  take  advantage  of  a 
priori  knowledge  of  the  system  and  prescribe  efficient  open-loop  controls  to  drive 
the  system  as  desired  without  sacrificing  sensitivity  reduction  associated  with 
feedback  control.  (For  related  ideas  see  [15]).  The  strategy  can  be  summarized 
in  four  steps: 

1.  Choose  intermediate  target  points  <?i,  <?2>  •  •  •  ,9r  between  and  g/  so  that 
the  “distance”  between  successive  target  points  is  small. 

2.  Specify  open-loop,  small-amplitude,  periodic  controls  that  drive  g(t)  of  (2.9) 
from  gi  to  the  first  target  point  g\  approximately.  To  do  so,  specify  controls 
that  drive  an  0(eq)  average  approximation  of  g(t)  from  gt  to  gx  exactly  (q 
to  be  determined). 

3.  If  desired,  apply  feedback,  i.e.,  make  appropriate  modifications  based  on 
measurement  of  the  new  system  state.  For  example,  modify  selection  of 
intermediate  target  points. 

4.  Repeat  steps  2  and  3  for  each  successive  target  point  (letting  the  previous 
target  point  be  the  new  initial  position)  until  done. 

Our  aim  in  this  chapter  is  to  solve  Step  2,  i.e.,  to  provide  the  means  to 
specify  open-loop  controls  that  solve  (P)  approximately.  We  use  the  formulas  for 
g^(t),  the  0(eQ)  average  approximation  of  g(t)  derived  in  Chapter  4,  and  the 
associated  averaging  theory  (e.g.,  Theorem  4.11)  that  allows  us  to  conclude  that 
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g(t)  will  remain  close  to  (to  0(eq))  over  a  relatively  long  (0(l/e))  time 

interval.  Of  critical  importance  is  knowing  how  to  choose  q  such  that  our  0(eq) 
average  solution  can  be  controlled  to  any  point  in  G.  In  other  words,  we  need  to 
determine  how  “good”  an  approximation  is  needed  to  capture  the  controllability 
of  the  system. 


In  Section  5.1  we  study  this  problem  of  relating  the  average  formulas  for  g^(t) 
of  Chapter  4  to  controllability.  Given  that  system  (2.9)  is  a  depth-*/'  bracket  sys¬ 
tem  (as  defined  in  Section  2.2.1),  we  show  that  q  —  q'  + 1  is  the  minimum  positive 
integer  q  such  that  an  0(eq)  average  solution  can  be  controlled  as  desired.  This 
section  is  of  particular  significance  because  the  proofs  within  explicitly  describe 
a  step-by-step  procedure  for  constructing  controls  to  drive  an  0(eQ)  average  ap¬ 
proximation  as  desired  and  thus  provide  a  constructive  methodology  for  solving 
(P)  with  0(eq)  accuracy. 


In  Section  5.2  we  describe  algorithms  for  depth-(*/  —  1)  bracket  systems,  q  = 
1,2,3,  that  systematically  synthesize  open-loop,  sinusoidal  controls  to  solve  (P) 
with  0(eq)  accuracy.  These  algorithms  are  derived  according  to  the  constructive 
procedure  of  Section  5.1.  We  illustrate  these  algorithms  for  examples  described 
in  Chapter  3.  In  Section  5.3  we  propose  a  control  architecture  for  motion  control 
systems  which  uses  the  algorithms  of  Section  5.2  to  provide  adaptation  to  changes 
in  control  authority  such  as  an  actuator  failure.  In  Section  5.4  we  describe  an 
experiment  that  was  run  to  test  the  algorithms  of  Section  5.2  on  an  underwater 
vehicle  in  the  neutral  buoyancy  tank  of  the  Space  Systems  Laboratory  at  the 
University  of  Maryland. 
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5.1  Constructive  Controllability 

Consider  system  (2.9)  with  solution  g(t )  £  G.  Let  q  >  1  be  an  integer.  If  we 
solve  the  complete  constructive  controllability  problem  (P)  for  an  0(eq)  average 
approximation  to  g(t )  then  we  will  have  solved  (P)  for  g(t)  with  0(eq)  accuracy. 
The  advantage  to  focusing  on  the  control  problem  for  an  0(eq)  average  solution 
is  that  we  have  explicit,  geometric  formulas  for  average  solutions  g^(t)  from 
Chapter  4.  The  formulas  for  g^(t)  grow  in  complexity  with  increasing  q  so  we 
would  like  to  consider  the  minimum  q  possible.  However,  if  we  choose  too  low  a  q 
then  our  0(e9)  average  approximation  might  not  be  controllable.  In  this  section 
we  study  the  problem  of  solving  (P)  with  0(tq )  accuracy  by  deriving  open-loop 
controls  that  drive  an  0(eq)  average  approximation  as  desired.  We  address  the 
problem  of  choosing  q  and  we  show,  by  means  of  the  proofs  of  two  lemmas  and 
a  theorem,  a  methodology  for  synthesizing  the  open-loop  controls. 

Let  Ip  be  the  length-p  ordered  list  of  indices  {i1} . . . ,  ip}  where  iu  £  {1, . . . ,  m}, 
v  =  1 , ,p.  Define  the  summation 

m  mm  m 

£  =  ££••■£• 

Ip=l  ii =1  *2=1  ip— 1 

Recall  from  (2.18)  that  the  depth-(p  —  1)  structure  constants  T*  are  defined  as 

k= 1 

In  the  following  we  denote  a  set  of  r  length-p  ordered  lists  of  indices  as  Ip, . . . ,  I*. 

Lemma  5.1  Suppose  that  system  (2.9)  on  the  connected  Lie  group  G  with  Lie 
algebra  Q  is  a  depth-#'  bracket  system.  Let  q  =  q'  +  1.  Then  for  any  W  £  Q, 
there  exist  n  constants 

{ci ,  ■  ■  •  ,  Cm,  Cjl  ,  •  •  •  ,  CjP 2  ,  C/1  ,  •  •  •  ,  C/P3  ,  ■  •  •  ,  C/1  ,  •  ■  •  ,  CjPq  } , 
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where  (m  +  Zf=2P;)  =  n  such  that 


m  Tl  P2  P3  Pq 

W  =  E  cA  +  £G>,.r‘  +  E  c.tf,  +  •  •  ■  +  E  c,,r) )& 

fc=l  fc=l  j=l  j=l  3  j=l  9 


and  {ELirj,&,...,ELir^,?t}  are  linearly  independent  for  alH  =  2, . . . ,  q. 

I  u 

In  other  words,  W  can  be  written  as  the  linear  combination  of  {£/, . . .  ,  £m}  and 
Pj  depth-(j  —  1)  bracket  terms,  j  =  2, . . . ,  q.  Further,  q  is  the  minimum  integer 
such  that  this  is  true. 


Proof.  In  Section  2.2.1  we  defined  C  to  be  the  set  of  Lie  brackets  generated  by 
{£i>  •  •  ■ ,  £m}-  Let  C(q C  C  be  the  subset  containing  Lie  brackets  up  to  depth-#', 

cW) ={v\v  =  [m>  [m- 1,[-  •  • ,  [m,  vo ]■  •  •]]]>  £m},  *  =  o, . . . ,  k,  k<  #'}. 

By  definition  of  a  depth-#'  bracket  system,  span(C^)  =  Q.  Thus,  any  element 
W  €  Q  can  be  written  as  the  linear  combination  of  Lie  brackets  of  {£/, . . . ,  £m} 
of  depth  less  than  or  equal  to  #'.  #'  is  the  minimum  integer  for  which  this  is  true 
since  span(C^”^)  ^  Q  for  #"  <  #'.  So  we  can  write 

mm  m 

w  =  £<*&  +  £>>[&.&.]+  !>»[[&.. &],&)  +  ••• 

k=l  /2  — 1  /3  =  1 

m 

T  CIq[£i  1»  [^2J  •  •  •  >  [£g-i>  £9]  •  •  •]] 

h= 1 

m  n  m  m  m 

=  E<*6  +  ■£,( E +  E  +  •••+  E (s.i) 

k= 1  k= 1  h= 1  /3=1  /,= 1 

where  c*,  k  =  1, . . . ,  m,  c/2,  /2  =  1, . . . ,  m,  . . .,  c/9,  Iq  =  1, . . . ,  m  are  constants. 
Since  Q  is  n-dimensional,  there  exists  a  choice  of  these  constants  such  that  (5.1) 
holds  with  only  n  of  the  constants  nonzero.  Let  these  n  nonzero  constants  be 
denoted  by 

{ci ,  .  .  .  ,  Cm,  C/l ,  .  .  .  ,  C/P2  ,  C/l ,  .  .  .  ,  C/P 3  ,  ■  .  .  ,  C/l ,  .  .  .  ,  C/P«  } , 
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where  (m  +  ]T^_ 2Pi)  =  n.  Then  W  is  as  in  the  statement  of  the  lemma,  i.e.,  the 
sum  of  m  depth-0  bracket  terms  and  pj  depth-(j  —  1)  bracket  terms,  j  =  2, . . . ,  q. 

Further  we  claim  that  the  bracket  terms  at  each  depth  are  linearly  inde¬ 
pendent,  i.e.,  {ELir/i^i---)Sfe=irrPi6}  are  linearly  independent  for  all  l  — 

i 

2, . . . ,  q.  If  not  then  W  has  been  described  by  fewer  than  n  linearly  independent 

□ 

terms.  This  is  a  contradiction  since  Q  is  n-dimensional. 

In  the  next  lemma  we  show  how  to  drive  g(t )  with  0(eq)  accuracy  to  a  point 
in  G  that  can  be  expressed  as  a  depth-(Z  -  1)  bracket  where  l  <  q.  This,  together 
with  the  previous  lemma,  will  be  used  in  Theorem  5.4  as  one  step,  to  be  repeated 
no  more  than  n  times,  for  driving  g(t)  with  0(eq)  accuracy  to  any  point  in  G. 
See  Section  2.3.2  for  definitions  of  Q,  S,  'Ir,  d. 


Lemma  5.2  Suppose  that  system  (2.9)  on  the  connected  Lie  group  G  with  Lie 
algebra  Q  is  a  depth-g'  bracket  system.  Let  q  =  q'  +  1.  Suppose  that  g0,gx  e 
Q  C  G  are  such  that  Zq  =  =  0(e9_1),  Y\  =  =  0(eq~l).  Let 

<?(0)  =  g0  and  let  l  €  {1, . . . ,  q}.  Further,  suppose  that  Yi  can  be  expressed  as  a 
depth-(Z  —  1)  bracket,  i.e., 


v  zT=iCkdk  i  =  i 
Y\  =  ' 

E£=i  cIio^kIio^k  l  >  ^ 

where  7;0  is  an  ordered  list  of  l  indices,  r^o  are  depth-(Z  —  1)  structure  constants 
and  Cfc,  c/i0  are  constants.  Consider  the  local  representation  of  g(t)  defined  by 
g(t)  =  ez^\  Z(t)  =  E)Si(— l)l+lelZi(t),  where  Zi(t )  are  given  by  (2.43)  Let 
e;  =  tq!x .  For  N  an  integer,  define 


Z{l)(NT )  =  (-1  )m(ei)liVZ,(T)  +  49) 
=  (-1  )l+1f*NZi(T)  +  49), 

g®  (NT)  =  ez(0(t). 
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Then  we  can  choose  an  integer  M  =  0(  1/e)  and  ej-amplitude,  periodically 
time-varying  controls  eiu(t)  =  ( e/«i ,£/um(t)),  satisfying  Tk(T)  =  0,  k  = 
0, 1, . . .  ,1  —  2,  (T*;(t)  defined  by  (2.43))  such  that 

Z{l)(MT)  =  Yi  +  49)- 

If  ||Z0  -  49) II  =  0(e9)  then 

||Z(MT)  -  ZW(MT)||  -  0(eQ), 
d(g(MT),g«\MT))  =  0(eg). 


Prop/  Let  u(t)  be  piecewise  continuous,  u(t  +  T)  =  u(t),  Vf  >  0.  Further  for 
Z  >  1  let  Tk(T)  =  0,  k  —  0, ...  ,1  —  2.  Suppose  that  e*  =  is  the  amplitude  of 
u(t)  (i.e.,  replace  e  in  (2.9)  by  e*)  and  note  that  ( e* )l  —  eg.  As  in  Theorem  4.11 
define 

zm(t)  =  E(-i)i+1(«i)iz.(t)  +  (-Vf+\u)‘^Z,(T)  + 

i= 1  1 

9V)(t)  = 

Let  b  >  0  be  as  defined  in  Theorem  4.11.  Note  that 

Z„  =  0(e«-1)  =  Otte1/')’-1)  =  0((e,)‘-‘'<)  =  0((e, 

If  \\Zti  -  4'"li  =  0((e,)‘)  =  0(e«)  and  Z<‘>(t)  €S,\/t€  [0, 6/e,]  3  [0,6/e],  then  by 
Theorem  4.11, 

||Z(i)  -  Z(l)(i)||  =  0((e,)<)  =  0(e«), 
d(g(t), gm(t))  =  0((f,)‘)  =  Ofe"),  Vie  [0,6/e,]. 
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Further,  for  t  —  NT,  N  an  integer, 


Z®(NT)  =  {-T)l+\tl)lNZl(T)  + 

=  (-1  )l+1tqNZt(T)  +  Z{q).  (5.2) 


The  lemma  is  proved  if  we  show  that  we  can  choose  ^-amplitude  periodic  controls 
eiu(t)  and  an  integer  M  =  0(l/e)  such  that  Z^(MT)  =  Y\  +  z[q\  This  is  the 
case  because  for  small  enough  e,  Z^(t)  G  S,t  G  [0,  MT]  since  Z^( 0)  =  0(eq~1) 
and  Y\  G  S. 

First,  consider  l  =  1  and  recall  that 

-T  m 

Z\{T)  =  T0(T)  =  /  U(r)dr  =  TUav  =  T  £  (5.3) 

k= i 

So  for  l  =  1  we  choose  an  integer  M  =  0(1/ e)  and  ei-amplitude,  periodically 
time-varying  controls  d  u(t)  —  (tiUi(t), . t\ um(t)),  t  G  [0,  MT],  such  that 


ck 


T  i  “‘(T)<<T  =  “”‘  =  T,«M’ 
Since  Y\  =  0(eq~l)  implies  c*,  =  0(eq~l), 


k  =  1, . . . ,  m. 


(5.4) 


0(eq~l) 

Uavk  = -^7T7N  =  0(  1). 


e«zO(l/e) 


Also,  from  (5.2),  (5.3)  and  (5.4), 


m 

ZW(MT)  =  eOMTj^Uavktk  +  Z^ 

k=l 

m 

=  e,Mr£^+z“ 
m 

=  £Cfc&  +  49) 

*:= i 

=  +  49). 


Next  we  consider  l  >  1.  By  Theorem  4.12 
Zip')  =  7  [[U(n),j/'\V(Ti),...,£-'u(Tl)dTl  ]...]*■, 
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where 


1  f1  JA  [T l  rn-\  7,1 

—  T  /  [  CnJ&i >  /  [  (^2 )£is >  •  •  •  ;  /  y~!  Uu  jjl)^l^,ii\  •  •  -l^7! 

4  '/0  ii=l  1/0  ia  =  l  1/0  i,=l 

1  fT  fTl  fTi- 1 

=  y  22  J0  Uii  (rl)  yo  «i9  (t2  )---Jo  «i,  (Tl)drl  ■  ■  ■  dTi  [& 


1  m  n 

=  y  E  A'.(T)Erf,&. 


/,=i 


fc=i 


A  /’T1  /■TJ-i 

A/, CO  -  /  uh (n)  /  ui2 (r2) ...  Ui, (n)dn ...dri. 

Jo  Jo  Jo 

Let  J  =  {/;  |  ii,. .  ,,ii  €  {1, . . . , ra}}.  The  elements  of  X  are  not  all  linearly 
independent  because  of  skew  symmetry  of  the  Lie  bracket  and  the  Jacobi  identity. 
However,  we  can  find  a  set  I  C  L  with  h0  6  X  such  that  the  elements  of  X  are 
linearly  independent.  For  example,  we  can  use  a  Philip  Hall  basis  of  depth-(Z  —  1) 
brackets  [66].  Then,  we  can  compute  terms  A /,(T),  h  6  X  such  that 

zI(r)  =  i£A,1(r)£r*&  (5.5) 

1  I,eX  fc= 1 

and  {Efc=i  F/^fcl/jex  are  linearly  independent.  The  terms  AJt(T),  h  £  X  are 
linear  combinations  of  the  terms  A /,(T),  h  €  X. 

So  choose  an  integer  M  =  0(l/e)  and  the  controls  u(t)  such  that  A ^(T)  is 
defined  by 


(-l)(+1€«MC/fo  h  ~  ho 

0  hex,  1^  il0 

Since  Yj.  =  0(e9_1)  implies  c/j0  =  0(e9_1), 


(5.6) 


By  (5.5)  and  (5.6), 


0(e9_1) 

^-^  =  0(1). 


Zl^  l  Jj  (-l)«+1e9MC/,°r^^ 

=  "  1  Y 

(-i  y+h^M  1- 


(5.7) 


no 


Thus,  by  (5.2)  and  (5.7), 


Z^(MT)  =  (-1  )l+1eqM  ^ 


(-1 


Yi  +  Z$ 


(<?) 


=  Y\  +  Zq 


(?) 


□ 


Remark  5.3  Consider  /  >  1.  Let  uj  =  2tt/T.  An  example  of  a  control  u(t)  that 
satisfies  u(t  +  T)  =  u(t),  Vf  >  0,  and  Tk(T)  =  0,  k  =  0, . . . ,  q  —  2  and  that  yields 
a  nonzero  value  for  the  term  A /;(T)  is  prescribed  by 


Ui  i (t) 


(l  -  l)wsin(/  -  l)ujt,  l  even 

< 

( I  —  l)o;cos (l  —  l)u;t,  l  odd 


ui2 (t)  =  ...  =  uk(t)  =u>cosu)t,  uk  =  0,  k  <£  Ii. 


In  this  case, 


A  ,,(T) 


(, l  -  l)ul  J0r  sin(/  - 1  )u)T\  /0Tl  cos  a ;r2  •  •  •  /0Ti  1  cos  coridri . . .  dr\ ,  l  even 
(i l  —  1  )cul  Jq  cos (l  —  /0Tl  cos  ujt2  ■  ■  •  Jo"'-1  cos  UJTidri . . .  dr\ ,  l  odd 


For  instance,  for  l  =  4,  let  /4  =  {ii,  «25  *4}  and 


tiii(f)  =  3u;sin(3a;f),  Wj2(f)  =  Ui3(t)  =  Ui4(t)  =  a;  cos  cot. 


Then  u(t  +  T)  =  u(t),  Vf  >  0  and 

/oT  Uk(r)dr  =  0,  k  e  I4  =>  T0(T)  =  0. 

foT  uj(n)  fon  uk{T2)dT2dr1  =  0,  j,  k  e  h  ==»  7\(T)  =  0. 

So  ui(ji)  fon  uj(ti)  So2  uk{T3)dT3dr2dTi  =  0,  i,  j ,  A;  €  J4  =>  T2(T)  =  0. 

Further, 

/•T  fTl  rT2  rT3 

A/.  (T)  =  3ur  /  sin3a;ri  /  cos  u;t2  /  coscut3  /  cosu;t4  dr4dr3dT2(fTi 

Jo  Jo  Jo  Jo 

—  — 7r/4. 


Ill 


Other  possibilities  include 


(t)  —  Ui3(t )  =  3wsin(3a >t),  Ui2(t )  =  iq4(t)  =  cocosut. 

In  this  case  Tk(T)  =  0,  k  =  0, 1,2  and  A /,(T)  =  — 97t/16.  For  l  =  2  we  recall 
from  (4.60)  that 

7i  m 

z,(T)  =  -  E(  E  ^(T)rf3.)&. 

fc=l 

Thus,  comparing  with  equation  (5.5)  in  the  proof  of  Lemma  5.2,  we  see  that  for 
l  =  2,  X  —  {i,  j  =  1, . . .  ,m-,i  <  j}  and  — |A /2(T)  =  Areaij(T).  If  we  choose 

Ui(t)  =  aiLOsinujt,  Uj(t)  —  ajujcosut,  Uk  =  0,  k  {i,  j}, 

then  u(t  +  T)  —  0,  Vt  >  0,  T0(T)  =  TUav  —  0,  Area,ij(T )  =  OfjO!j7r  and 
Areaik(T)  =  Areajk(T)  =  Areakk>(T)  =  0,  k,k'  £  {i,j}. 

The  next  theorem  gives  the  main  result  of  this  section. 

Theorem  5.4  Suppose  that  system  (2.9)  on  the  connected  Lie  group  G  with 
Lie  algebra  Q  is  a  depth-g'  bracket  system.  Let  q  =  q'  +  1.  Then  the  complete 
constructive  controllability  problem  (P)  can  be  solved  with  0(eq)  accuracy  using 
the  formulas  g^(t)  given  by  (4.37)  for  r  =  1, . . .  ,q.  Further,  q  is  the  minimum 
positive  integer  such  that  this  is  true. 

Proof.  Without  loss  of  generality  we  can  assume  for  problem  (P)  that  #(0)  = 
gi  =  e  e  G  and  gf  G  Q  C  G  is  such  that  d(gi,gf)  =  0(e9~1).  This  is  possible 
due  to  the  left  invariance  of  the  system.  The  initial  and  final  conditions  desired 
for  the  local  solution  defined  by  the  single  exponential  representation  g(t)  =  ez ^ 
are  Z( 0)  =  4f_1(^)  =  ^_1(e)  =  0  €  Q  and  Z/  =  4r_1(^y)  G  Q.  As  a  result, 

IIZ/II  =  II Z;  -  Z(0)||  =  d(gi,gf)  =  0(e«->). 
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By  Lemma  5.1  there  exist  n  constants 


{ci,...,  Cmi  C/i  i  •  •  •  j  CjP2  ,  Cn ,  •  •  •  ,  CjP 3  ,  ■  .  .  ,  C/i ,  .  .  .  ,  CjPg  } , 


where  (m  +  £f=2P()  =  n  and 

m  n  p  2  P3  Pq 

z,  =  E  <*&  +  E<E  +  Ec,<dj+-+E  )&. 

fc=l  fc=i  j=i  j=i  3  j= l  9 

Further,  {££=1  . . . ,  r^P,^}  are  linearly  independent  for  alli  =  2, . . . ,  q. 

Let 

m  n  n  n 

Yi  =  £  cfc&,  y2  =  £  c,.r*,Gh  n  =  E  ■  ■  ■ ,  y„  -m+1  —  C/P«  i> 


fc=l 


fc=l 


fe=l 


A;=l 


Then 


n— m+1 

z,=  E  n- 

J=1 


(5.8) 


Let  M  =  0(l/e)  be  an  integer.  We  show  by  induction  on  j  that  we  can  choose 
periodically  time-varying  controls  u(t)  —  (ui(t), um(t))  such  that 

\\Z(jMT)-f^Yi\\  =  0^),  j  =  1 . n-m  +  1.  (5.9) 

1=1 

Consider  j  =  1.  Let  Yoi  =  Z(0)  =  0  and  Y^f  =  0.  Let  =  eg.  By  Lemma  5.2 
we  can  choose  ei-amplitude  periodically  time-varying  controls 
ei u(t)  —  {eiUi(t), . . .  €i um(t)),  t  €  [0,  M],  such  that 

II Z(MT)  -  V, ||  =  || Z(MT)  -  (Vi  +  y0(1',))||  =  0(<f). 


Now  suppose  (5.9)  holds  for  j  =  j'  —  1.  Then 

II Z((j'  -  1  )MT)  -  ’■£  y,||  =  0(e«).  (5.10) 

t=l 

Let  Y0.,  =  Z((f  -  1  )MT)  and  let  YqJ)  =  YllJi  Yi-  Zf  =  0(e9_1)  implies  by  (5.8) 
that  Yif  =  0(eq~1).  By  (5.10) 

\\Y0]l-Y^\\=O(eq),  (5.11) 
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and  so  Y0j,  -  0(e9_1).  By  definition  Yj>  =  c/rT^f*,  some  l  G  {2, 
some  r  G  {l,...,p*}.  By  Lemma  5.2  we  can  choose  q-amplitude,  periodically 
time-varying  controls  qu(t)  =  (qui(t), . . . ,  c/um(t)),  <  G  [(/  -  1)MT,  j'AfT],  such 
that 


II ZU'MT)  -  ( Yj,  +  y0“)||  =  0(e"). 


So  by  (5.12), 


3 

I 

i- 1 


=  ||Z(/MT)  -  (y,.  +  15)11 

i=l 

=  ||Z(/MT)  -  (Y,  + 

=  0(0, 


(5.12) 


i.e.,  (5.9)  holds  for  j  =  j'.  So  by  induction  (5.9)  is  true  for  all  j  =  1, . . . ,  n—m+1. 

We  can  choose  the  frequency  and  amplitudes  of  the  controls  such  that  tf  of 

problem  (P)  is  tf  =  (n  +  m-  1  )MT.  Then  from  (5.9)  for  j  =  n  -  m  +  1, 

n-m+l 

Wtf)  -  Z,\\  =  -  £  Kill  =0(0. 

1=1 

Since  Zf  G  S,  then  Z(tf)  G  S  for  small  enough  e.  So  by  definition  of  d, 

d(9(t,),gI)  =  \\Z(t,)-Z,\\  =  0(S). 

This  means  that  (P)  is  solved  with  0(eq)  accuracy. 

Now  suppose  q  <  q.  The  0(eq)  average  approximation  of  g(t)  can  only  be 
driven  to  points  ezf  G  G  where  Zf  can  be  expressed  as  the  linear  combination 
of  depth-((/  —  1)  brackets.  However,  by  Lemma  5.1  q  is  the  minimum  integer  for 
which  Zf  can  be  expressed  as  the  linear  combination  of  depth-(g  —  1)  brackets. 
Thus,  the  gth-order  average  solution  cannot  be  controlled  to  arbitrary  points  in 
G. 

Remark  5.5  The  proofs  of  Lemma  5.1,  Lemma  5.2  and  Theorem  5.4  provide  a 
procedure  for  constructive  controllability. 
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5.2  Algorithms  for  Control  Synthesis 

In  this  section  we  use  the  constructive  methodology  of  Section  5.1  to  derive 
algorithms  that  synthesize  open-loop  controls  to  solve  the  complete  constructive 
controllability  problem  (P)  with  0(eq)  accuracy  for  depth-((/  —  1)  bracket  systems 
(2.9),  q  =  1, 2, 3.  These  algorithms  are  notably  low  in  computational  burden.  The 
controls  are  small-amplitude  sinusoids  that  are  designed  to  be  continuous  and  to 
satisfy  u(0)  =  u(tf)  =  0.  For  a  drift-free  system,  u(0)  =  u(tf)  =  0  means  the 
system  is  initially  and  finally  at  rest.  Additionally,  we  allow  for  flexibility  in  some 
of  the  choices  of  control  parameters  so  that  the  period  of  the  controls  T  can  be 
made  relatively  large  if  desired  (e.g.,  to  avoid  exciting  vibrational  modes  in  the 
system).  T  should  satisfy  tf/T  =  0(  1/e).  Thus,  for  example,  T  can  be  increased 
if  tf  is  increased,  i.e.,  if  the  time  constraint  on  completing  the  motion  control 
maneuver  can  be  relaxed. 

We  have  chosen  to  use  sinusoids  for  our  control  inputs,  rather  than  some 
other  type  of  periodically  time-varying  function,  for  a  couple  of  reasons.  First, 
following  Remark  5.3,  sinusoids  are  relatively  easily  chosen  in  accordance  with  the 
constructive  procedure  of  Section  5.1,  i.e.,  it  is  clear  how  to  select  the  resonances 
between  the  different  control  inputs  to  generate  motion  as  desired.  Second,  si¬ 
nusoids  are  optimal  for  certain  systems  (2.9)  on  certain  Lie  groups  in  the  sense 
that  they  solve  the  following  optimal  control  problem: 

(P’)  Let  J{u)  =  ft*  L(u(t))dt  define  a  cost  function.  Find  u(-)  that  minimizes 
J(u )  subject  to  the  condition  that  <?(0)  =  and  g{tj)  =  <//. 

For  example  consider  the  spacecraft  attitude  control  problem  of  Section  3.1 
with  only  two  controls,  i.e.,  G  =  SO( 3)  and  m  =  2.  Let  L(u)  =  l/2(Jiwf  +  hul) 
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where  I*  >  0,  i  =  1,2.  Then  J(u)  is  the  energy  expended  and  problem  (P’) 
is  the  motion  control  problem  with  minimal  energy.  Baillieul  showed  that  the 
optimal  solutions  u\(t)  and  u^t)  to  this  problem  are  sinusoids  for  I\  =  /2  =  1. 
[4].  Brockett  showed  that  for  the  three-dimensional  nilpotent  system  described 
in  Section  3.5,  i.e.,  G  =  H( 3)  and  m  =  2,  with  L(u )  =  l/2(Iiul  +  I2ul),  problem 
(P’)  is  also  solved  with  sinusoids  [13].  More  recent  work  on  optimal  control  of 
systems  on  Lie  groups  by  Jurdjevic  [28]  and  Krishnaprasad  [34]  has  revealed  other 
types  of  periodically  time-varying  controls  as  optimal  solutions.  For  example, 
in  [34]  Krishnaprasad  showed  that  elliptic  functions  solve  the  optimal  control 
problem  (P’)  with  L(u)  =  u\  +  u\  for  the  unicycle  described  in  Section  3.2,  i.e., 
G  —  SE{ 2)  and  m  =  2. 

We  assume  for  our  algorithms  that  in  problem  (P),  ft  =  e  6  G  and  gf  e  Q  C 
G  is  such  that  d(gi,  gj)  =  This  is  possible  due  to  the  left  invariance  of  the 

system.  The  assumption  implies  that  the  algorithm  prescribes  controls  for  small 
maneuvers.  Given  a  motion  control  problem  which  involves  a  large  maneuver, 
we  first  break  it  down  into  small  steps  by  selecting  target  points  between  gi  and 
gj  and  then  apply  the  appropriate  algorithm  to  each  step.  The  selection  of  these 
target  points  is  not  addressed  in  this  dissertation.  However,  we  note  that,  for 
a  suitable  measure  of  energy,  more  energy  is  expended  to  move  along  a  depth- j 
bracket  direction  for  larger  values  of  j.  Thus,  a  more  energy  efficient  choice  of 
target  points  minimizes  motion  along  higher  depth  bracket  directions. 

Recall  the  single  exponential  local  representation  g(t)  =  e z('t\  Locally,  we 
want  to  drive  Z(t)  to  Zf  =  ^_1( gj )  €  Q.  We  assume  that  Zf  is  given  and 
Zf  =  (zfv . . . ,  Zfn)T  computed  such  that  Zf  =  Yn=izfiG-  if  Zf  is  given  with 
respect  to  some  other  basis  {771 , . . .  ,rjn}  for  Q,  then  a  linear  transformation  will 
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be  needed  to  compute  (zj1, . . . ,  Zfn). 


Recall  the  product  of  exponentials  local  representation  g(t)  =  e71^^1  •  •  •  eln^n . 
Suppose  that  g/  E  Q  C  G  and  that  7 /  =  4/_1(g/)  E  is  given.  This  is  the  case, 
for  example,  if  the  desired  orientation  of  the  spacecraft  (Section  3.1)  is  given 
in  terms  of  Euler  angles  (7/1,7/2)7/3)-  Since  we  assume  g(0)  —  —  e  then 

Z( 0)  =  \P-1(<7(0))  =  0  E  Q.  By  definition  of  d  (2.46), 

lli>/i?.ll  =  IIZ/I!  =  \\z,  -  Z(0)||  =  d(gi,gt)  =  0(c«-'). 

1=1 

Thus,  Zfi  =  0(e9-1)  and  so  by  Lemma  2.10  for  G  a  matrix  Lie  group  and  q>  1  it 
follows  that  7 =  0(eq~1)  and 

I zfi  -  7/il  =  0(e2(9-1))  =  0(eq),  i  =  1, . . . ,  n. 

So  suppose  we  drive  Z(t)  such  that  \\Z(tf)  -  E”=i  7/^i||  =  0(eq),  then 

Tl  Tt  Tl  Tl 

ll^(*/)  -  X>/i&ll  =  II^(^/)-E^  +  Et/^-Et/^II 

i=  1  i=  1  i=l  i= 1 

<  II z{tf)  -  E  7/^11  +  II E  7 ~Y,zfM 

i= 1  i= 1  i=l 

=  0(eq). 

So  we  can  use  the  7 /  and  Zf  interchangeably  for  G  a  matrix  Lie  group,  i.e., 
given  7 f  we  set  Zf  =  7 f.  Further  let  z(t)  =  (z\(t), . . . ,  zn(t))T  be  defined  by 
Z(t)  =  £”=1  Then,  for  2(0)  =  0  and  z{tf )  =  zj  =  0(eq~l),  we  can  assume 

that  z(t )  =  0(e9_1),  t  E  [0,  f/].  So  again  by  Lemma  2.10  for  G  a  matrix  Lie 
group  and  q  >  1,  7 (t)  =  0(eq~l),  t  E  [0,t/],  and 

||7(f)  -  z{t)\\  =  0(e2(<z-1))  =  0(eq),  t  E  [0,  tf],  (5.13) 

We  will  use  this  result  in  the  examples  at  the  end  of  this  section. 
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As  in  the  proof  of  Theorem  5.4,  the  algorithms  in  this  section  are  designed 
to  solve  the  motion  control  problem  using  multiple  substeps.  The  time  interval 
[0,  tf]  is  divided  into  subintervals,  e.g.,  [0 ,tf]  =  [to,h]U[ti,t2]U-  •  t0  = 

0,  t M  =  tf,  and  controls  specified  on  each  subinterval.  The  controls  are  specified 
so  that  the  terms  Areaij(T)  and  )  will  take  on  a  single  constant  value  on 

each  subinterval.  However,  these  terms  may  take  on  different  values  on  different 
subintervals.  Thus,  for  ease  of  notation  we  define  the  “running  total”  of  the  time- 
varying  area  terms  and  moment  terms  as  Areaij(t )  and  ra^i),  respectively.  Let 
Area[^(T)  and  mf£l(T)  be  the  values  of  the  area  and  moment  terms,  respectively, 
during  the  time  interval  [tr-\,  tr]  and  suppose  that  t  e  [tu,  t„+i],  0  <  u  <  fi.  Then 
define 

Area,, (i)  =  ±  ^-±AAre^(T)  +  ft-^Area^ (T),  (5.14) 

r~\ 

mllt (t)  =  ±  {tr m$(T)  +  (5.15) 

r=l 

5.2.1  Algorithm  0:  Depth-Zero  Bracket  System 

The  depth-zero  bracket  system  is  a  trivial  case  since  m  =  n.  We  are  given 
gi  =  e  G  G,  J2i= i  —  Zf  —  4'-1(<7/)  =  0(1)  and  tf  >  0.  Choose  M  to  be  a 
positive  integer  such  that  M  >  I/7 re.  Let  the  period  T  and  frequency  u  of  the 
controls  be 


Define  controls  eiik(-)  for  k  =  1, . . . ,  n  by 

euk(t)  =  -jj—  sin2  cut,  0  <  t  <  tf. 

M  IT 

Then  euavtf  =  M  euk{r)dT  —  Zfk.  This  means  that  g^(tf)  =  etUavtf  —  eZs  = 
gf,  i.e. ,  the  first-order  average  approximation  is  driven  exactly  to  gf  at  t  —  tf  as 
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desired. 


5.2.2  Algorithm  1:  Depth-One  Bracket  System 

For  the  depth-one  bracket  (single  bracket)  system  we  have  m  <  n.  We  are  given 
<7i  =  e  G  G,  Zi=i  zfi&  —  Zf  —  'l,-1(5/)  =  0(e)  and  tf  >  0.  Algorithm  1  has  two 
parts,  Part  A  and  Part  B  defined  below. 


PART  A:  By  Lemma  5.1  there  exist  constants  Ck,Cij  such  that 


n  m 


Zf  =  Y1  Zfk&  =  H  m  OijFijZk- 

k=l  k=l  k=l  i,j=l\i<j 


(5.16) 


Further,  these  constants  can  be  chosen  so  that  only  n  of  them  are  nonzero.  We 
compute  Ck,Cij  such  that  (5.16)  holds,  i.e.,  such  that 


zfk 


=  < 


,  m 


ck  +  ES-liK,  k  —  1, ... ,: 

K“=i,,<jcvrf,  k  =  m+ 


(5.17) 


Consider  the  matrix 


r  - 


12  L  13 


pm+1  pm+1 
1  12  1  13 


pm+2 


..  r 


1  m  1  23 


pn  rn  rn  pn 

1  12  1  13  •  •  •  Mm  1  23 


•  •  •  r>2m  •  •  •  r 


pm+1  pm+1  pm+1  pm+1 

lm  ^23  •  •  ■  ^  2m  •  •  ■  ^  (m— l)m 


pn  pn 

1  2m  '  •  •  1  (m— l)m 


Note  that  f  has  rank  n  —  m.  We  give  two  options  for  choosing  the  constants 

Ck )  Cij  • 


119 


Option  ( 1 ):  From  the  left  write  down  the  first  n—m  linearly  independent  columns 
of  f  as 


r  =  [r*  ..  •  •  •  r,  ,1  g 

L  ‘m+ljm+l  t'njn  J 

i*,jv  G  iu  <  j„,  v  =  m  +  l,...,n. 

Then  T  is  nonsingular.  So  let 


Cij  =  0  if  Tjj  not  a  column  of  T, 

m 

=  zfk  ~  Y  ciA’  k  =  l, . . .  ,m. 

i,j=l;i<j 

Option  (2):  Define  the  generalized  inverse  of  f  to  be  ft  =  fT(ffT)~1.  Then  let 


°k  =  zfk  ~  Y  cur^>  k  =  l,...,m. 

i,j=l-,i<j 

For  either  option,  let 

S  =  {k  |  Ckj  7^  0,  some  j  >  k},  r  =  |5*|  =  number  of  elements  in  S. 

PART  B:  Following  the  proof  of  Theorem  5.4  we  apply  controls  to  drive  an  0(e2) 
average  approximation  of  g(t)  to  gf  at  t  =  tf.  Component  l(i),  described  below, 
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prescribes  controls  to  achieve  desired  motion  in  the  depth-zero  directions.  This 
is  done  simply  by  noting  that  for  sinusoidal  control  inputs  in  phase,  area  terms 
Areaij(T )  will  all  be  zero.  When  all  area  terms  are  zero  and  =  0  by  (4.36), 

m 

Z^(t)  =  eU(t)  =  J2euk(t)Ck. 

k= 1 

Comparing  this  with  (5.16),  we  see  that  to  achieve  the  desired  motion  in  the 
depth-zero  bracket  directions,  we  want  euk(tf)  =  ck,  k  =  1,. . .  ,m.  According  to 
Lemma  5.2  and  Remark  5.3,  for  Z ^  =  0  and  M  an  integer, 

n  m 

zW(MT)  =  -e2MZ2(T)=e2Mj2  £  Area^T)^. 

k= 1  i,j=l;i<j 

Comparing  this  to  (5.16),  it  is  clear  that  to  achieve  the  desired  motion  in  the 
depth-one  bracket  directions,  we  want  e2 M Areaij(T)  to  be  equal  to  c^-.  Compo¬ 
nent  l(ii)  prescribes  controls  to  achieve  this  depth-one  bracket  motion. 

Choose  M  to  be  a  positive  integer  such  that  M  >  \/ire.  Let  the  period  T  and 
frequency  u  of  the  controls  be 

rp  tf  _2tt 

=  r(M  +  1)  +  1/2’ 

Then  using  the  controls  defined  in  Components  l(i)  and  1  (ii) ,  perform  the  fol¬ 
lowing  iterations: 

1.  i  =  0. 

2.  i  =  i  +  1. 

3.  If  i  ^  S  go  to  5. 

4.  Apply  Component  1  (ii)  for  Cij,  j  =  i  +  1, . . . ,  m. 

5.  If  i  <  m  —  1  go  to  2. 
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6.  Apply  Component  l(i)  for  ck,  k  =  1, . . . , m. 


Then  we  are  done  and  d(g(tf),gf)  =  0(e2)  as  desired. 

In  the  following  control  laws,  if  a  control  component  is  not  explicitly  prescribed 
it  should  be  set  equal  to  zero. 

Component  l(i) 

Given:  ck,  k  =  1, . . . ,  m,  T,  to  and  current  time  t0. 

Goal:  Let  t\  =  t0  +  T/2.  We  define  euk(t),  k  =  1, . . . ,  m,  t  e  [t0,ii],  continuous, 
such  that  eufc(fi)  =  ck  and  euk(ti)  =  euk(t0)  =  0. 

Controls: 

1 

euk(t)  =  -cku>sin(u)(t  -  t0)),  t0<t  <ti. 


Component  1  (ii) 


Given:  i  <  j,  Cij  for  j  =  i  +  1, . . . ,  m,  T,  to,  M  and  current  time  t0. 
Goal:  Let  t\  —  to  T  (M  -4-  l)r.  Let 


Oii 


=  E 


A 


1/4 


j=i+l  *2M2) 


Oil  = 


_  '-'ij 


oti^M  ’ 


j  =  i  +  l,...,m. 


Specify  continuous,  zero-mean  controls  Ui(t),  Uj(t),  j  =  i  +  1, . . . ,  m,  t  G 
[t0,ti]  such  that  e2Area,ij(ti)  =  c,j,  eui(t0)  —  eui(ti)  =  euj(t0)  =  eu3(ti)  = 

0. 
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Controls: 


eUi(t)  =  aiusin(u(t  —  t0)) 
euj  (t)  =  0 

eui(t)  =  aiU)cos(u>(t  —  si)) 
euj(t)  =  aju>sin(u)(t  —  Si)) 
eui(t )  =  aiLUCos(uj(t  —  s2 )) 

6Uj(t)  =  0 


>  to  <  t  <  to  +  T  —  Si 


>  si  <  t  <  Si  4-  MT  =  s2 


^  s2  <  t  <  s2  +  —  tl 


Note  that  e2 Areai j{t\)  =  ctiCtjTtM  =  Cij  and  the  goal  is  met. 


Remark  5.6  Option  (1)  can  be  considered  as  the  time  optimal  option  since  it  se¬ 
lects  the  minimum  number  of  nonzero  constants  Cij,  thus,  minimizing  the  number 
of  times  Component  l(ii)  is  called.  Option  (2)  can  be  thought  of  as  the  mini¬ 
mum  energy  option  since  it  gives  a  least  squares  solution  to  the  selection  of  c^-. 
In  Component  1  (ii) ,  given  the  chosen  structure  of  the  controls,  the  amplitudes 
Oi,ctj  are  selected  to  minimize  energy  J(u)  =  f^((eui(t))2  +  YJj=i+\{^j(t))2)dt 
and  to  satisfy  a^jirM  =  c^.  This  amounts  to  choosing  to  minimize  {a2  + 
Xq=i+i(cij/ai7rM)2}.  ^  !he  control  inputs  are  not  all  equally  costly  to  use,  the 
constants  a,,  aj  could  be  computed  instead  to  minimize  a  weighted  energy  func¬ 
tion.  Finally,  we  note  that  Component  1  (ii)  is  energy  (and  time)  saving  in  that 
it  meets  several  depth-one  bracket  conditions  simultaneously. 


5.2.3  Algorithm  2:  Depth-Two  Bracket  System 

For  the  depth-two  bracket  (double  bracket)  system  we  have  m  <  n.  We  define 
0  <  l  <  (n  —  m)  such  that  the  relative  growth  vector  a  defined  by  equation  (2.14) 
is  a  =  (m,  l,n  —  (m  +  l)).  In  particular,  let 

E  =  {pe{m  +  l,...,n}\Tpij  0  som ei,j  G  m},  i  <  j}.  (5.18) 
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Then  l  =  |E|  =  number  of  elements  in  S.  We  will  assume  for  the  purposes  of 
the  algorithm,  without  loss  of  generality,  that  the  basis  {£i,--.,£n}  is  ordered 
such  that  {m  +  1, . . . ,  m  +  1}  6  E.  We  are  given  gi  —  e  €  G,  £"=1  Zf^i  =  Zf  = 
^ ~1(9f )  =  0(e2)  and  tf  >  0.  Algorithm  2  has  two  parts,  Part  A  and  Part  B 
defined  below. 


PART  A:  By  Lemma  5.1  there  exist  constants  cp,Cy,  such  that 

n  m  n  m  m 

zf  =  J2  zfPtp  =  Z  cp£p  +  Z  Z  (carij  +  cijidiji+  Z  cij^ijk)CP-  (5-19) 

P= 1  p=  1  p=  1  ij=l;i<j  k—i+l 

Further,  these  constants  can  be  chosen  so  that  only  n  of  them  are  nonzero.  We 
compute  cp,Cij,Cijk  such  that  (5.19)  holds,  i.e.,  such  that 


zh 


=  < 


cp  +  2y=l;i<i +  Ciji@iji  +  Y2k=i+1  cijk@ijk)  P  =  1)  •  ■  •  j  m 

A  ciji@iji  +  Sfc=i+1  cijk@ijk)  P  =  m  +  1,  ■  ■  •  ,  TTl  +  l 

+  S3Z+1  Cijk^ijk)  P  =  TU  +  l  +  1,  .  .  .  ,n 

(5.20) 


Consider  the  matrix 


9  = 


7121  V122 


am+i+1  /jm+1+1 
”l21  ”l22 

nm+l+ 2  .nm-t-i+2 


on 

^121 


an 

"l22 


.  6> 


12m 


am+l+l 
•  •  ^m 


.  9 


1  mm  ”232 


.  .  . 


(m— l)mm 


zjm+i+1  /jm+i+l  /im+/+l 

•  •  "lmm  p232  •  •  •  >-l)mm 


9n 


and  the  matrix 


r  = 


12  1  13 


lm  1  23 


2m 


(m— l)m 
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■pm+1  pm+1  nm+1  nra+1  nm+1  nm+1 

1  12  1  IS  •  •  •  1  1m  -I  9S  ■  •  ■  1  9m  •  •  •  i 


13 


1  m 


23 


2  m 


pm+2 


■pm+l  pm+l  pm+!  pm+I  pm+l  pm+1 

J-  12  1  1 S  •  •  •  Mm  i  93  •  •  •  J-  9m  •  •  •  lu 


13 


1  m 


23 


2  m 


Let  ct  =  m  + 1.  Then  9  has  rank  n  —  a  and  f  has  rank  l.  We  give  two  options  for 
choosing  the  constants  cp,Cj,,  Cy*. 


Option  ( 1 ):  From  the  left  write  down  the  first  n—a  linearly  independent  columns 
of  9  as 

f)  =  \Q.  ,  ...  fj.  .  ,  1  p  S»(«-a)x(«-“) 

U  Fia+Ua+lfca+l  Ulnjnkn]  C 

iui  jui  ky  mj,  iy  Jj/j  iy  ky ,  u  —  ex  -j- 1 , ...  ,n. 

Then  8  is  nonsingular.  So  let 


Ci(x+\ja+\ka+\ 

Zfa+ 1 

l 

=  9~l 

• 

^ injnkn 

Zfn 

Cijk  =  0  if  9ijk  not  a  column  of  9. 

From  the  left  write  down  the  first  l  linearly  independent  columns  of  f  as 

r  =  [r(1J-,  •  •  •  riu,]  e  #*• 

iyi  jy  €  {lj  •  •  •  j  ,  iy  <  jy,  V  —  1,  .  .  .  ,  /. 

Then  T  is  nonsingular.  So  let 


chji 

Zfm+ 1  +  YlT=i+l  Cij^ijk  ) 

=  T~ 1 

: 

Ciljl 

_  */«+,  -  HSWMS?4  +  SE-+I  <%*«?) 
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Cij  =  0  if  Tij  not  a  column  of  T, 

m  m 

Cp  Zf  p  —  +  Ciji@iji  "P  Cijk@ijk)  P  f  ■  ■  •  >  m- 

i,j=l-i<j  k-i+l 

Option  (2):  Define  the  generalized  inverse  of  §  to  be  ft  =  6T(dQT)~l.  Let 


■ 

Cl21 

r  -| 

Cl22 

=  ft 

Zfm+l+ 1 

Zfn 

Define  the  generalized  inverse  of  f  to  be  ft  =  fT(f  fT)  f  Then  let 


Cl2 

Cl3 

=  ft 

Zfm+ 1  Sij'=l;i<  j  (  +  Sfc=j+1  Cijk^ijk  ) 

Zfm+l  ~  ^i,j=l\i<jiCiji^ijt  +  cijk^k  ) 

m  m 

cp  ~  zfp  —  ^  {cij^ij  +  Cijidiji  +  ^  cijkftjk)  P  —  1,  ■ .  ■  ,rri. 

i,j=l-,i<j  fe=i+ 1 

For  either  option,  let 

Y  {cijk  |  Cijk  7^  0,  i  <  j,i  < 

Q  =  {c^k  €  Y  |  i  <  j  <  k},  /3  =  \Q\  =  number  of  elements  in  Q, 

R  =  {Cijk  eh|fc  =  i}u  {cijk  EY  \k  =  j  and  &  Y}, 

V  =  {cjj  |  Cij  7^  0,  i  <  j'}, 

W  =  {cijk  €  R  |  &V},  5=\W\  +  \V\. 


PART  B:  Following  the  proof  of  Theorem  5.4  we  apply  controls  to  drive  an 
0(e 3)  average  approximation  of  g(t)  to  gf  at  t  =  tf.  Component  2(i),  described 
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below,  prescribes  controls  to  achieve  motion  in  the  depth-zero  bracket  directions 
as  in  Algorithm  1.  The  first  portion  of  Component  2(ii),  also  described  below, 
achieves  motion  in  the  depth-one  bracket  directions  as  in  Algorithm  1.  Here, 
however,  the  amplitude  of  the  controls  are  of  order  e2  =  e3,/2  as  specified  in  the 
proof  of  Theorem  5.4.  According  to  Lemma  5.2  and  Corollary  4.18,  for  Zq  —  0 
and  M  an  integer, 

Z{3)(MT)  =  e3MZ3(T) 

n  m  m 

=  -£3M£  £  WV*  +  £  (2mijk(T)  -  mikj(T))0(jt)(r. 

p=  1  i,j=l',i<j  k=i+ 1 

Comparing  this  to  (5.19)  it  is  clear  that  to  achieve  the  desired  motion  in  the  depth- 
two  bracket  directions  we  want  e3 Mm^T)  to  be  equal  to  —c%]l  and  e3(2mijfc(T)  — 
mikj{T ))  to  be  equal  to  —  cijfc.  The  remainder  of  Component  2(ii)  prescribes 
controls  to  satisfy  the  former  while  Component  2(iii)  prescribes  controls  to  satisfy 
the  latter. 

Choose  M  to  be  a  positive  integer  such  that  M  >  l /we.  Let  the  period  T  and 
frequency  a ;  of  the  controls  be 

T  = _ U _  m  =  — 

(6/?  +  35)(M  +  1)  +  1/2’  T‘ 

Then  use  the  controls  defined  in  Components  2(i),  2(ii)  and  2(iii)  to  perform  the 
following  iterations: 

1.  i  =  0. 

2.  i  =  i  4- 1,  j  =  *. 

3.  j  =  j  +  1,  k  =  j. 

4.  k  =  k  +  1.  If  k  =  m  +  1  go  to  8. 
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5.  If  Cijk  —  Cj hj  —  0  go  to  7. 

6.  Apply  Component  2(iii)  for  and  c^j. 

7.  If  k  <  m  —  1  go  to  4. 

8.  If  Cij  —  Ciji  —  Cijj  =  0  go  to  10. 

9.  Apply  Component  2(ii)  for  c^,  cl3l  and  c^j. 

10.  If  j  <  m  —  1  go  to  3. 

11.  If  i  <  m  —  1  go  to  2. 

12.  Apply  Component  2(i)  for  cp  for  p  =  1, . . . ,  m. 

Then  we  are  done  and  d(g(tf),gf )  =  0(e3)  as  desired. 

In  the  following  control  laws,  if  a  control  component  is  not  explicitly  prescribed 
it  should  be  set  equal  to  zero. 

Component  2(i) 

This  component  is  the  same  as  Component  l(i)  of  Algorithm  1. 

Component  2(ii) 

Given:  i  <  j,  ,  Ciji,  c^j,  T,  u>,  M  and  current  time  to- 
Goal:  Let  h  =  t0  +  3 (M  +  1)T  and 


n-  —  11 —  rv  —  n  ■  — 

U n  ail7rM’  32  SIf 33  ~  a^TrM  ’ 

Specify  continuous,  zero-mean  controls  Ui(t)  and  Uj(t),  t  G  [to^i];  such 
that  e3Area,ij(ti )  =  c^-,  e3m,iji(ti)  =  — e3m,ijj(ti)  =  —c^j  and  eui(ti)  = 
cUi(t0)  =  cUj(ti)  =  euj(t0 )  =  0. 
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Controls: 


€Ui(t)  =  Oj1tt;sin(a;(t  -  t0)) 
zuj(t)=  0 

eui(t)  =  cos(u(t  —  si )) 
euj(t)  =  a^u;  sin(u;(t  —  Si)) 

eui(t)  =  GcnU) cos(u)(t  -  s2)) 


tu 


;(t)  =  0 


,  T 

^  to  <  t  <  to  +  —  —  Si 


/  5l  ^  t  ^  5i  +  MT  —  S2 


,  3  T 

>  S2<i<S2  +  T  =  S3 


eui(t)  =  ai2u) si n(u>(t  -  s3)) 

€Uj (t)  —  2otj2uj  sin(uj(t  —  s3)) 

eui(t)  =  ai2ucos(u)(t  -  s4)) 
euj (t)  =  2ctj2co  cos(2u(t  -  54)) 

eui(t)  =  a;j2w  cos(a;(t  -  s5)) 
euj (t)  =  2ctj2uj  cos(a;(t  -  s5)) 

et/j  (i)  =  2aj3a;sin(a;(t  —  sq)) 

=  ai3uj  sin(a;(£  -  s6)) 

€Ui(t )  =  2aj3wcos(2a;(t  —  57)) 
ettj(t)  =  aj3wcos(tt;(t  —  s7)) 

eiti(t)  =  2oj3a;cos(a;(t  -  s8)) 

euj(t)  =  Oj3wcos(a;(t  —  s8)) 

The  condition  on  Areaij(t )  is  met  during  the  time  interval  [0,  s3],  the  condition 
on  )  is  met  during  [s3,  s6]  and  the  condition  on  )  is  met  during  [s6,  sg\. 


?  S3  <  t  <  s3  +  —  =  s4 


>  s4  <  t  <  Si  +  MT  —  s5 


^  8  <t<s  +  —  -s 


r  56  ^  ^  56  +  ~  —  57 


/  57  <  t  <  S7  +  MT  —  58 


,  3T 

?  Sg  <  t  <  s8  +  —  —  S9 
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Component  2(iii) 

Given:  i<j  <  As,  cijk,  cikj,  T,  u>,  M  and  current  time  tQ. 

Goal:  Let  tx  =  t0  +  6(M  + 1  )T.  Let  dx  =  2{\cijk  +  \clk])l*M  and  d2  =  2(| cijk  + 
Select 

Ph  =  (f )  1  >  Pil  =  (  ^  ’  Pfcl  =  «i«i’ 

Ph  =  (f )  7  ’  A2  =  )  ’  Pfc2  =  Aa«s’ 

We  specify  continuous,  zero-mean  controls  «i(t),  n7-(t)  and  ^(t),  t  e  [^o,  ti], 
such  that  e3(2mijfc(ti)  =  -cijk,  e3{2mikj{t1)  =  -cifcj, 

€«<(*!)  =  e«i(to)  =  «*j(*l)  =  «b'(t0)  =  =  eUk ^  =  °-  Further> 

Areaij(ti)  =  Areaik(tx)  =  Areajk(ti )  =  0. 

Controls: 

=  PnOJ  sin (w(t  -  to)) 

ewj(t)  =  2pJ1o; sin(cu(t  -  t0))  (  t0  <  t  <  t0  +  -  =  «i 
eMfe(t)  =  Pfei^  sin(w(t  -  to)) 

> 

Ctti(t)  =  PiiWCOS^t  -  Si)) 

c«j(t)  =  2pilo;co8(2w(t-«1))  \  si  <t  <  si  +  MT  =  s2 

ewfc(t)  =  pklu>cos(uj(t  -  Si)) 

€«i(t)  =  PiiU>COs(u>(t  -  S2)) 

euj{t)  =  2pJ-1wcos(w(t  -  s2)) 
c«fc(t)  =  pfelu;cos(u;(f  -  s2)) 

The  condition  on  mijfc(t)  is  met  during  the  time  interval  [0,s3].  However,  the 
values  of  mtji(t)  and  mjkk(t)  at  t  =  s3  may  be  different  from  their  initial  condition. 

So  repeat  the  controls  above  replacing  t0  with  s3,  si  with  s4,  s2  with  s5  and  s3 
with  s6.  Also,  replace  p31  by  -pjx  and  set  euk{t)  =  0,  t  £  [s3,  s6].  During  [s3,  «6], 


3T 

s2  <  t  <  s2  +  —  —  S3 
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the  original  value  of  is  restored.  Repeat  the  controls  above  again,  this 

time  replacing  to  with  s6,  sx  with  S7,  s2  with  s8  and  s3  with  s9.  Also,  replace  pjx 
by  —  pj1  and  set  eui(t)  =  0,  t  G  [^6,  s9].  Then,  during  [s6,  S9]  the  original  value  of 
m,jkk(t)  is  restored. 

Finally,  rerun  the  entire  set  of  controls  for  t  €  [to,  s9],  exchanging  the  roles  of 
j  and  k,  augmenting  the  indices  of  the  time  intervals  appropriately.  Also,  replace 
PH  by  pi2,  pjx  by  pj2  and  pkl  by  pk2.  Then  tx  =  Sx8  and  e3(2mijk(t1)  -mikj(tx))  = 
-cijk,  e3(2 mikj(ti)  -  mijk(ti))  =  -cikj.  Thus,  the  goal  is  met. 


Remark  5.7  As  discussed  in  Remark  5.6,  Option  (1)  can  be  interpreted  as  the 
time  optimal  option  and  Option  (2)  as  the  minimum  energy  option.  The  con¬ 
stants  otiX,  QZfai  Component  2(ii)  and  Pi\,  Pj\i  Pfci?  Pj2^  Pk2 

of  Component  2(iii)  have  been  selected  to  minimize  energy  analogously  to  that 
described  for  Component  l(ii)  in  Remark  5.6.  In  general,  we  note  for  all  of  the 
algorithms  that  the  energy  fgf  YJk=i(^uk{t))2dt  is  inversely  proportional  to  tj. 


Remark  5.8  Since  the  solution  to  system  (2.9)  depends  analytically  on  the 
structure  constants,  the  control  inputs  generated  by  the  algorithms  also  depend 
analytically  on  the  relevant  structure  constants,  i.e.,  the  structure  constants  asso¬ 
ciated  with  the  basis  {£1, . . .  ,£„}  for  Q  that  appear  in  Part  A  of  the  algorithms. 
Small  errors  in  system  description  are  equivalent  to  small  errors  in  structure 
constants.  Because  the  specified  controls  depend  analytically  on  the  structure 
constants,  these  errors  translate  into  small  errors  in  specified  controls.  Thus,  the 
open-loop  controls  derived  from  these  algorithms  are  robust  to  modelling  errors. 
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5.2.4  Examples 

Spacecraft 

Consider  the  spacecraft  attitude  control  problem  of  Section  3.1  where  only  two 
components  of  angular  velocity  (about  the  bi  and  b2  axes)  can  be  controlled. 
Then,  from  (3.3),  X(t)  €  G  =  SO( 3)  and 

X  =  tX(u\A\  +  U2A2),  (5.21) 

where  {Ai,  A2,  A3}  is  the  standard  basis  for  so(3).  The  only  relevant  nonzero 
structure  constant  is  Tf2  =  1  since  [Ai,A2]  =  A3.  Thus,  from  Theorem  4.3  and 
Corollary  4.16, 

z{i\t)  =  euxit)  +  zi£\ 

42)  (t)  =  ^u2(t)+z2io\ 

z3\t)  =  e2^Areau{T)  +  z3{q\  (5.22) 

X^(t)  =  e^i= or  X{2)(t)  =  ezi  )(t)/l2e42)(<)^3^ 

and  A^2)(f)  is  an  0(e2)  approximation  of  X(t)  on  an  0(l/e)  time  interval.  This 
result  implies  that  oscillations  about  the  bi  and  b2  axes  can  produce  a  net 
rotation  about  the  b3  axis.  We  note  that  this  result  and  the  control  algorithm 
below  apply  equally  to  the  ball  and  plate  example  of  Section  3.4  (with  the  roles 
of  bj  and  rj  reversed)  since  the  ball  and  plate  problem  is  also  described  by  (5.21) 
with  G  =  50(3). 

Since  (5.21)  is  a  depth-one  bracket  system,  we  use  Algorithm  1  to  construct 
open-loop  controls  to  solve  (P)  with  0(e2)  accuracy.  We  are  given  m  =  2,  n  =  3, 
X(0)  =  9i  =  I  and  7 /  =  {jfv  7/2,  7/3)T  =  ^_1(5/)  =  0(e)  and  tf  >  0.  We 
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set  zf  =  7 /.  The  matrix  f  is  f  =  T12  =  rf2  =  1.  Options  (1)  and  (2)  yield 
T  =  P  =  1.  Thus,  since  r}2  =  rf2  =  0, 

C12  =  7/3/r  =  7/3>  ci  =7/i  -ci2r}2  =  7/l,  c2  =  7/2  -  ci2r?2  =  7/2, 

and  S  =  {1},  r  =  1.  We  choose  an  integer  M  >  1  / 7re  and 

T  =  tf  =  — 

M  +  3/2’  "  T  ’ 

Then  we  apply  Component  l(ii)  for  ci2  followed  by  Component  l(i)  for  ci  and 
c2.  Let  ti  =  j,  t2  =  ti  +  MT,  t3  =  t2  +  <4  =  tf  =  t3  +  The  controls  are 

then  defined  as  follows: 


For  numerical  illustration,  let  e  =  0.1,  7^  =  0.085,  7/2  =  0.03,  7/3  =  0.2 
and  tf  =  23.  Choose  M  =  10,  then  T  =  2,  u  =  7r,  a.\  =  a2  =  0.08,  ti  =  0.5, 
t2  =  20.5,  t3  =  22  and  =  23.  Figure  5.1  shows  plots  of  the  corresponding 
controls  eux  and  eu2  as  a  function  of  time.  Figures  5.2(a),  5.2(b)  and  5.2(d)  show 
a  simulation  of  the  response  of  the  Wei-Norman  parameters,  71,  72,  73  for  the 
attitude  control  problem  (solid  lines).  Figure  5.2(c)  is  a  plot  of  ux  versus  u2 
for  t  e  [tx,t2],  and  the  area  enclosed  by  the  curve  is  equivalent  to  Areai2(T). 
The  simulation  was  produced  by  numerically  solving  the  equations  (3.4)  using 
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Figure  5.1:  Control  Input  Signals  for  Spacecraft  and  Unicycle  Examples. 


MATLABr.  The  dashed  lines  of  Figure  5.2  represent  the  0(e2)  average  approxi¬ 
mation  of  the  parameters  as  a  function  of  time  computed  directly  from  the  average 
formulas  (5.22).  Thus,  the  dashed  lines  represent  the  prescribed  trajectory  of  the 
parameters.  Figure  5.2  shows  that  the  actual  parameters  (solid  lines)  follow  the 
prescribed  average  solution  (dashed  lines)  with  0(e2)  accuracy  as  expected.  From 
Figure  5.2  we  see  that  ||'y(i)  ||2  <  7r,  Vt  G  [0 ,t/]  which  implies  that  ||z(t)||2  <  7r, 
Vt  G  [0,t/].  By  Theorem  2.8  (Lazard  and  Tits)  and  Remark  2.9  for  Q  —  so(3) 
we  set  S  =  {Eli  aiA  G  so(3)  |  |ja||2  <  7r}.  Then,  Z(t)  G  S',  Vt  G  [0,t/]  and 
so  d(X(t),  X^(t))  =  0(e2),  Vt  G  [0,t/].  In  particular,  d(X(tf),gf)  =  0(e2),  i.e., 
the  spacecraft  has  been  reoriented  as  desired  with  0(e2)  accuracy. 
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Figure  5.2:  Actual  (solid  lines)  and  Average  (dashed  lines)  Wei-Norman  Param¬ 
eters  for  Spacecraft  Attitude  Control  Example. 

Unicycle 

Consider  the  unicycle  motion  control  problem  of  Section  3.2.  From  (3.11)  X(t)  E 
G  =  SE( 2)  describes  the  position  and  orientation  of  the  unicycle  and  satisfies 

X  =  eX{^A\Ui  +  A2W2),  (5.24) 

where  {Ai,A2,A3}  is  the  basis  for  se(2)  defined  by  (3.10).  This  system  is  a 
depth-one  bracket  system  and  the  only  relevant  nonzero  structure  constant  is 
rf2  =  1  since  [A\,  A2]  =  A3.  The  relevant  structure  constants  for  this  system  are 
the  same  as  those  for  the  spacecraft  attitude  control  problem  with  two  controls. 
Therefore,  X^ft)  described  by  equations  (5.22),  with  {Ai,A2,A3}  interpreted 
as  the  basis  for  se(2),  is  an  0(e2)  average  approximation  of  X(t)  E  SE( 2)  on 
an  0(  1/e)  time  interval.  Moreover,  Algorithm  1  applied  to  the  unicycle  problem 
yields  the  same  controls  defined  by  (5.23).  Applying  the  control  input  of  (5.23) 
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Figure  5.3:  Response  for  Unicycle  Example. 

to  the  unicycle  problem,  with  the  same  values  for  e,  7/,  tf,  etc.,  used  to  illustrate 
the  spacecraft  example,  yields  unicycle  Wei-Norman  parameter  responses  similar 
to  those  shown  in  Figure  5.2.  Figure  5.3  shows  the  response  of  the  unicycle  in 
(x,y,9)  coordinates.  One  can  observe  that  the  unicycle  has  been  repositioned 
and  reoriented  with  0(e2)  accuracy. 

In  general,  the  controls  defined  by  (5.23)  solve  (P)  with  0(e2)  accuracy  for 
any  single-bracket  system  of  the  form  (2.9)  with  n  =  3  and  m  =  2.  One  simply 
needs  to  compute  cu  =  2/3/rf2,  <7  =  zjx  —  Ci2rj2  and  c2  =  Zf2  —  Ci2rf2.  By 
definition,  7^  0.  Brackett’s  system  of  Section  3.5  is  an  example.  In  this  case,  in 
addition,  G  —  H( 3)  is  nilpotent  of  order  2,  and,  as  a  consequence  of  Theorem  4.9, 
the  controls  of  (5.23)  will  solve  (P)  for  this  system  exactly.  By  Theorem  4.9, 
X(t )  G  H( 3)  is  given  by  X(t )  =  ezl2]^ .  By  Theorems  4.10  and  4.11,  for  t  =  NT, 
N  an  integer,  and  Uav  =  0,  Z®(t)  =  Z^(t).  So,  X(NT)  =  ezW^  =  X^(NT). 
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Underwater  Vehicle 


Consider  the  autonomous  underwater  vehicle  (AUV)  motion  control  problem 
of  Section  3.3.  First,  suppose  that  we  can  control  angular  velocity  about  the 
bi,b2,b3  axes  and  translational  velocity  along  the  bi  axis.  Then  from  (3.14), 
X(t)  €  G  —  SE( 3)  describes  the  orientation  and  position  of  the  vehicle  and 
satisfies 

4 

X  =  eX(J2ui{t)Ai),  (5.25) 

i= 1 

where  {Ai,...,^}  is  the  basis  for  se(3)  defined  by  (3.12).  This  system  is  a 
depth-one  bracket  systems.  The  nonzero  structure  constants  corresponding  to 
our  chosen  basis  for  se(3)  can  easily  be  computed  as  r32  =  r23  =  T31  =  1, 
n5  =  rjjj  =  1,  r®2  =  r26  =  1,  r34  =  r|3  =  l.  Thus,  from  Theorem  4.3  and 
Corollary  4.16, 

zi](t )  =  eu^t)  +  e2±Area23(T)  +  z^,  zj2)(t)  =  eu4(t)  +  z$\ 

z£\t)  =  eu2(t)  -  e2±Areal3(T)  +  z2{o\  z{3\t)  =  e2±Areau(T)  +  z^\ 

z3\t)  =  eu3(t)  +  e2^Areau(T)  +  z3  Jj2),  z{e\t)  =  -e2±Area24(T)  +  z6J2) , 

(5.26) 

(t)  =  e£i=.  or  X(2)  =  -q  ez?\t)Ai  > 

2=1 

and  X(2\t)  is  an  0(e2)  approximation  of  X(t)  on  an  0(l/e)  time  interval. 

Since  (5.25)  is  a  depth-one  bracket  system,  we  use  Algorithm  1  to  construct 
open-loop  controls  to  solve  (P)  with  0(e2)  accuracy.  We  are  given  m  =  4,  n  =  6, 
X(0)  =  gi  =  I  and  7/  =  (7/i>  •  •  ■  ,7/6)T  =  ^_1(<//)  =  0(e)  and  tf  >  0.  Set 
Zf  =  7/.  We  compute 

r  =  [  r12  r13  T23  r24  r34] 
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r5 

1 12 

r5 

1  13 

r?4 

r5 

1  23 

ii 

ri4 

r6 

1 12 

r6 

1  13 

r?4 

r6 

1  23 

F24 

r$4 

0  0 

0 

0  0 

1 

0  0 

0 

0  -1 

0 

Options  (1)  and  (2)  of  Part  A  yield 


r  = 

p5  p5 

1  24  1  34 

0  1 

,  ft  = 

0  0  0  0  0  1 

p6  p6 

L  24  1  34 

-1  0 

0  0  0  0  -1  0 

Therefore,  both  options  give 


C24 

=  r-i 

ZS  5 

0 

-1 

Zf  5 

~Zf6 

C34 

.  ^6  _ 

1 

0 

.  Z ^  . 

Z /5 

Cl2  =  C13  =  C14  -  C23  =  0, 

Ci  =  Zf 4  —  C24T24  —  C34r34  =  Zf^,  C2  =  Zf2  ~  024^4  —  C34T34  =  Zf  2, 

C3  =  zf$  ~  C24T24  —  C34r34  =  Zf  3,  C4  =  Zf  4  —  C24r24  C34T34  =  Zf  4, 

5  =  {2,3},  r  =  2. 

So  we  choose  an  integer  M  >  1/ne  and 

T  =  tf  =  — 

2(Af  +  l)  +  l/2’  ^  T' 


Then  we  apply  Component  1  (ii)  for  c24  followed  by  Component  1  (ii)  for  c34  fol¬ 
lowed  by  Component  l(i)  for  c4,  c2,  C3,  C4.  To  reduce  the  time  and  energy  expended 
by  the  controls  we  can  instead  apply  Component  1  (ii)  just  once.  To  do  this  let 
i  =  4,  j  —  2,3,  c42  =  —  c24,  C43  =  — C34  and  apply  Component  1  (ii)  to  match  C42 
and  C43.  In  this  case  we  have  S  =  {4}  and  r  =  1  so  we  recompute 


T  = 


tf 

M  +  3/2’ 
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Let  t\  =  j,  t2  =  h  +  MT,  t3  =  t2  +  t4  —  tf  —  t3  +  j.  The  controls  are  then 


defined  as  follows: 

eu\(t)  = 


eu2{t)  = 


eu3(t)  = 


eu4(t)  = 

where  a4  =  f'7,7  j'/-1,  a2 


0 

0  <t<t3 

|ciwsin(a;(t  -  t3)) 

t3  <t<t4 

0 

0  <  t  <  ti 

a2uj  sin (u>(t  —  t4 )) 

t1<t<t2 

0 

t2  <t<t3 

\c2lo  sin {uj(t  -  t3 )) 

t3<t<tA 

0 

0  <  t  <  ti 

0:30;  sin(c o(t  —  ti)) 

tl  <  t  <  t2 

0 

t2<t<t3 

\c3uj  sin (u(t  -  t3)) 

Tf 

*fo 

VI 

■to 

VI 

CO 

HO 

a 4u>  sin  cut 

0  <  t  <  t3 

^c4u  sin(u(t  —  t3 )) 

t3<t<U 

c42/a4nM,  a3  =  c43/a4nM. 

(5.27) 


For  numerical  illustration,  let  e  =  0.1,  Zf{  =  7 ^  =  0.1,  i  =  1, . . . ,  6,  and 
tf  =  23.  Choose  M  =  10,  then  T  =  2,  u;  =  7r,  a4  —  0.067,  «2  =  0.047, 
0*3  =  —0.047,  1 1  =  0.5,  t2  —  20.5,  t3  =  22  and  t4  =  23.  Figure  5.4  shows  plots  of 
the  corresponding  controls  eui  and  eu2  as  a  function  of  time.  Figure  5.5  shows 
a  simulation  of  the  response  of  the  Wei-Norman  parameters  7  as  a  function  of 
time.  The  simulation  was  produced  by  numerically  solving  the  equations  (3.17) 
using  MATLAB.  The  horizontal  dashed  lines  of  Figure  5.5  represent  the  desired 
final  parameter  value  7 j.  Figure  5.5  shows  that  7 (tf)  —  7/  =  0(e2)  as  expected. 
By  Theorem  2.8  (Lazard  and  Tits)  and  Remark  2.9  for  Q  =  se(3)  we  can  let 
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Figure  5.4:  Control  Input  Signals  for  AUV  Example  with  Four  Controls. 

S  =  {A  E  se( 3)  |  ||A||P  <  7t/2}  for  any  p.  From  Figure  5.5  it  is  clear  that 
Zf  E  S  and  Z(tf )  E  S  for  some  choice  of  p.  Thus,  || Z(tf)  —  Zf\\  =  0(e2) 
implies  d(X(tf),gf)  =  0(e2),  i.e.,  the  AUV  has  been  repositioned  and  reoriented 
as  desired  with  0(e2)  accuracy. 


Now  consider  the  case  when  there  are  only  three  controls  available:  angular 
velocity  control  about  the  bi  and  b2  axes  and  translational  velocity  control  along 
the  bi  axis.  By  (3.15)  X(t)  G  SE( 3)  satisfies 


X  —  cX (uiAi  T  U2A2  A  W4A4), 


(5.28) 


which  is  a  depth- two  bracket  system.  The  relevant  nonzero  depth- two  structure 
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Figure  5.5:  Response  of  AUV  with  Four  Controls. 

constants  are  0\.n  =  —  1,  92m  —  0\ 42  =  #f24  =  1-  From  Corollary  4.18, 

z[3\t)  =  eih{t)  +  ^m122(T),  43)(t)  =  eu4(t)  -  ^m242(T), 

43)(0  =  tu2(t)  -  pmUi(T),  z{3\t)  =  -^(2ra124(T)  -  rai42(T)), 

43)W  =  eV  2(t),  43)W  =  -^a24{t). 

XW(t)=eZl 

and  X^it)  is  an  0(e3)  approximation  of  A(t)  on  an  0(l/e)  time  interval. 

Since  (5.28)  is  a  depth-two  bracket  system,  we  use  Algorithm  2  to  construct 
open-loop  controls  to  solve  (P)  with  0(e3)  accuracy.  For  the  purpose  of  the 
algorithm,  we  reorder  our  basis  for  se(3)  such  that  A3  <=>  A4  and  A5  A6  (see  the 
first  paragraph  of  Section  5.2.3).  The  nonzero  structure  constants  associated  with 
this  reordered  basis  become  rf2  =  r24  =  T41  =  1,  =  r|4  =  1,  T|2  =  r25  =  1, 
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=  Tg4  =  1.  Further,  0423  =  1.  Thus,  n  —  6,  m  =  3,  and  so  by  (5.18), 
S  =  {4, 5}  and  l  =  |S|  =  2.  Thus,  we  get 

0  =  [0121  0122  0123  0131  0132  0133  0231  0232  0233] 

_  f/36  nG  aG  aG  aG  aG  aG  aG  aG  1 

—  Lt7121  a122  (7123  a132  a133  P231  P232  ^233] 


0  1 

0 

0  0 

-  . 

1  0  0], 

[Ti2 

Tl3 

r  23] 

r?2 

rf3 

it, 

1  0  0 

r?2 

ri3 

rla  _ 

0  0-1 

Options  (1)  and  (2)  yield  the  same  selection  of  constants.  Following  Option  (1), 

0  =  0123  =  0?23  =  1- 

C123  =  e~lZf5  =  Zf5, 

Cl21  =  C122  =  C231  =  C232  =  C233  =  C131  =  C132  =  C133  =  0. 

Note  that  z/5  is  based  on  the  original  ordering  of  the  basis  for  se(3)  and  so  it  is 
the  coefficient  of  A&  in  the  reordered  basis. 


r  = 

r?2 

r4 

1  23 

1  0 

_  r?2 

CO 

WO(N 

0 

1 

1 — 1 

1 _ 

So 


C12 

=  r-4 

Zfz  C1230123 

=  r-4 

zfs 

Zf  3 

C23 

ZSg  ~  C1230123 

.  . 

.  ~Zf*  . 

C13  =  0, 

Cl  =  Zf1  -  (Ci2r[2  +  C23r23  +  Ci230]23)  =  Zfv 

c2  =  Zf2  -  (ci2r?2  +  C23r23  +  C1230123)  =  ZS2 > 

c3  :=  zfi  —  (Cl2r?2  +  C23r23  +  0123^123)  =  Zf4, 

^  =  {Cl23},  Q  =  {Ci23},  R  =  0,  V  =  {C12,  C23},  W  =  0,  /3  =  1,  7  =  2. 
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So  we  choose  an  integer  M  >  1/n e  and 

T  = _ tl _  U  =  ^L 

12(M  +  1)  +  1/2’  T' 

Then  we  apply  Component  2(iii)  for  e12 3,  followed  by  Component  2  (ii)  for  C12, 
followed  by  Component  2(ii)  for  c23,  followed  by  Component  2(i)  for  Ci,c2,C3. 
These  components  will  specify  controls  wi,«2  and  it3.  However,  w3  is  really  our 
original  control  U4  since  it  is  the  coefficient  of  the  original  A4. 

For  this  particular  system  we  note  that  the  algorithm  is  longer  than  necessary, 
i.e. ,  there  are  steps  which  have  zero  net  effect  on  the  system.  Thus,  to  save 
time  and  energy  we  eliminate  the  unnecessary  steps  of  the  control  algorithm 
defined  above.  Specifically,  since  c233  =  0  and  ci32  =  0  we  can  leave  out  the 
controls  defined  during  [s6,si8]  of  Component  2(i)  (this  requires  a  change  in  the 
computation  of  d\  to  di  =  Additionally,  since  C121  =  Ci22  =  c232  = 

c233  =  0  we  can  leave  out  the  controls  defined  during  [s3,  s9]  of  Component  2(ii) 
each  time  it  is  applied.  Further,  we  can  apply  the  first  part  of  Component  2(ii) 
just  once  for  both  Ci2  and  c23  as  in  Component  l(ii)  of  Algorithm  1.  The  total 

time  duration  of  the  parts  left  out  is  9 (M  4-  1)T  so  we  recompute 

tf  _2'k 

=  3(M  +  1)  +  1/2’  UJ~T' 

Let  ti  —  £2  =  t\  +  MT,  t3  =  t<2  +  ^4  =  t3  +  j,  t8  =  +  MT ,  U  = 

t7  =  t6  +  f8  =  t7  +  MT,  tg  =  t$  +  tio  =  tg  +  The  controls  are  then 

defined  as  follows: 

r 

Pi^sinoA  0  <  t  <  £6 

0  t§  <  t  <  t7 

eu\(t)  =  <  a1o;sin(c j(t  —  t7))  t-j  <  t  <  t8 
0  t8<t<t9 

|ciu;sin(a;(t  —  tg))  tg  <  t  <  tw 
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eu2{t)  =  < 


(5.29) 


eu4(£)  — 


2p2uj  sin  tut 

0  <  £  <  £1 

2 p2co  cos(2tu(t  —  fi)) 

£1  <  £  <  £2 

2  p2uj  cos(c o(t  —  t2 )) 

£2  <  £  <  £3 

— 2p2tusin(tu(i  —  t3)) 

£3  <  £  <  £4 

—2  p2co  cos(2  uj{t  —  t4 )) 

£4  <  £  <  £5 

—2  p2u  cos  (u(t  —  t5 )) 

£5  <  t  <  k 

a2  sin (u(t  -  t6 )) 

£6  <  £  <  £9 

|c2tu  sin(tu(t  — 19)) 

£9  ^  ^  £h 

p4uj  sin  tot 

0  <  £  <  £3 

0 

£3  <  £  <  £7 

ct4a;  sin(tu(t  -  £7 )) 

£7  <  £  <  t8 

0 

£8  <  £  <  £9 

|c4o>  sin(tu(t  — 19)) 

£9  ^  £  ^  £10 

where  p2  =  (c123/67rM)1/3,  pi  =  (Ici^/p^M])1/2,  p4  =  cu3/ pip2nM ,  c2i  =  -c12, 
ol2  -  ((C23  +  cl^/^M2)1^,  «!  =  c2i/a27rM,  a4  =  c23/ol2t\M. 


For  numerical  illustration,  let  e  =  0.2,  £/  =  37  and  nffl  =  0.05,  7 /2  = 
0.05,  7/3  =  0.04,  7 /4  =  0.06,  7/5  =  0.05,  7/6  =  0.05.  Let  z/  =  7/.  Choose 
M  —  5,  then  T  =  2,  co  —  n,  p2  —  0.08,  p\  —  0.20,  p4  =  0.20,  a2  =  0.06, 
ai  =  —0.04,  a4  =  —0.05.  Figure  5.6  shows  plots  of  the  corresponding  controls  eu1} 
eu2  and  eu4  as  a  function  of  time.  Figure  5.7  shows  a  simulation  of  the  response 
of  the  Wei-Norman  parameters  7  as  a  function  of  time.  The  horizontal  dashed 
lines  of  Figure  5.7  represent  the  desired  final  parameter  values  7 /.  Figure  5.7 
shows  that  7 (tf)  —7 /  =  0(e3)  as  expected.  We  conclude  that  the  AUV  has  been 
repositioned  and  reoriented  as  desired  with  0(e3)  accuracy. 
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1 


Figure  5.6:  Control  Input  Signals  for  AUV  Example  with  Three  Controls. 

5.3  Adaptation  to  Changes  in  Control  Author¬ 
ity 

In  this  section  we  describe  a  control  architecture  that  uses  open-loop  control  gen¬ 
erating  algorithms  such  as  those  of  Section  5.2  to  provide  adaptation  to  changes 
in  control  authority  for  drift-free  systems  of  the  form  (2.9)  on  the  Lie  group  G 
with  Lie  algebra  Q.  Control  authority  is  defined  to  be  the  particular  choice  of  m 
control  inputs  which  can  be  actuated,  i.e.,  the  choice  of  £i, . . .  ,  £m  €  Q  such  that 
U(t)  —  YJ?=i  Ui{t)U  and  ui(t), . . . ,  um{t)  can  be  actuated  independently. 

Given  a  Lie  algebra  Q,  there  is  a  minimal  number  mo  <  n  of  controls  and  at 
least  one  choice  of  mo  controls  for  which  the  system  is  controllable.  If  the  original 
choice  of  control  authority  includes  m  >  m0  controls,  then  even  in  the  event  of  a 
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Figure  5.7:  Response  of  AUV  with  Three  Controls. 

change  in  control  authority  that  reduces  the  number  of  available  controls  (such 
as  an  actuator  failure),  the  system  might  still  remain  controllable.  In  this  case, 
we  can  use  the  algorithms  of  Section  5.2  (and  higher-order  algorithms  that  can 
be  derived  according  to  the  procedure  of  Section  5.1)  to  maintain  control  over 
the  system. 

As  described  in  Remark  5.8,  the  open-loop  controls  depend  essentially  on  the 
relevant  structure  constants  associated  to  the  basis  {£i,...,£n}  and  the  subset 
A  change  in  control  authority  changes  the  structure  of  the  sys¬ 
tem  by  changing  the  relevant  structure  constants  since,  in  particular,  the  subset 
{£i, . . .  ,£m}  is  changed.  We  can  adapt  to  such  a  structural  change  if  the  sys¬ 
tem  remains  controllable  by  using  the  new  relevant  structure  constants  in  the 
appropriate  algorithm  to  recompute  open-loop  controls. 
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For  instance,  consider  a  depth-one  bracket  system  with  m  controls  and  sup¬ 
pose  that  during  operation  there  is  a  change  in  control  authority  such  that  with 
the  remaining  m  -  1  control  inputs  the  system  is  a  depth- two  bracket  system. 
Then  to  adapt  to  the  change  in  control  authority,  we  switch  from  the  open-loop 
controls  (motion  script)  generated  by  Algorithm  1  to  open-loop  controls  (motion 
script)  generated  by  Algorithm  2.  To  make  the  switch  on  the  fly  after  such  a  fail¬ 
ure,  one  could  first  terminate  the  single-bracket  system  motion  script  by  bringing 
the  active  controls  to  zero  and  then  begin  controlling  the  system  according  to  the 
double-bracket  system  motion  script. 

The  AUV  motion  control  problem  of  Section  3.3  with  control  authority  in¬ 
cluding  four  control  inputs  is  an  example  of  such  a  system.  Suppose  the  control 
authority  includes  the  four  controls  as  in  the  example  of  Section  5.2,  i.e.,  angular 
velocity  control  about  the  bi,  b2,  b3  axes  and  translational  velocity  control  along 
the  bi  axis.  The  system 

X  =  eX(tui(t)Ai), 

i=l 

where  X(t)  €  SE(3)  and  A{  are  defined  by  (3.12),  is  a  depth-one  bracket  system. 
During  normal  operation  we  can  control  the  AUV  with  this  control  authority 
using  the  open-loop  controls  of  (5.27).  However,  in  the  event  of  an  actuator  failure 
these  controls  may  not  be  appropriate.  If,  during  the  course  of  operation,  one  of 
the  actuators  for  angular  velocity  control  fails,  the  system  is  still  controllable.  As 
discussed  in  Section  3.3,  if  u\  fails  then  the  system  remains  a  depth-one  bracket 
system.  In  this  case,  we  can  continue  to  control  the  AUV  with  open-loop  controls 
computed  from  Algorithm  1  based  on  the  new  control  authority.  If  u2  or  u3  fails, 
the  system  becomes  a  depth-two  bracket  system.  In  this  case,  we  can  continue 
to  control  the  AUV  with  open-loop  controls  computed  from  Algorithm  2  based 
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Figure  5.8:  Control  Architecture. 


on  the  new  control  authority.  For  a  failure  of  u3  we  use  the  controls  specified  by 
(5.29). 


Figure  5.8  represents  the  type  of  overall  control  architecture  that  we  envision 
to  incorporate  open-loop  control  planning  and  intermittent  feedback  (described 
earlier  in  the  chapter),  as  well  as  a  second  level  of  feedback  to  allow  for  adap¬ 
tation  to  changes  in  control  authority.  The  motion  script  generator  represents 
algorithms  such  as  those  of  Section  5.2  which  produce  open-loop  controls  (motion 
scripts)  to  achieve  desired  motions.  The  first  level  of  feedback  control  comple¬ 
ments  the  open-loop  control  by  adding  (possibly  intermittent)  feedback  to  make 
the  motion  control  more  robust.  The  second  level  of  feedback  control  is  used  for 
adaptation  to  changes  in  control  authority  such  as  an  actuator  failure.  When 
such  a  change  is  sensed  the  open-loop  control  generator  switches  motion  scripts 
as  necessary.  The  first  level  of  feedback  control  is  also  updated  to  account  for  the 
change  in  control  authority. 
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Figure  5.9:  Front  View  of  SCAMP. 

5.4  Underwater  Vehicle  Experiment 

In  this  section  we  describe  an  experimental  implementation  of  Algorithm  1  on  an 
underwater  vehicle  built  and  operated  in  the  Space  Systems  Laboratory  (SSL) 
at  the  University  of  Maryland.  The  SSL  designs,  builds  and  evaluates  integrated 
telerobotic  systems,  including  free-flying  vehicles  and  modular  manipulators  for 
space  operations  such  as  space  structure  assembly  and  satellite  servicing  [2] .  Test¬ 
ing  is  done  in  the  SSL’s  Neutral  Buoyancy  Research  Facility,  a  water  tank  50  feet 
in  diameter  and  25  feet  deep,  located  at  the  University  of  Maryland.  The  condi¬ 
tions  in  the  tank  are  intended  to  simulate  zero-gravity  conditions  of  space. 

SSL’s  Supplemental  Camera  and  Maneuvering  Platform  (SCAMP),  illustrated 
in  Figure  5.9,  moves  freely  and  carries  a  video  camera  on  board  [3].  For  space 
operations,  it  provides  an  external  view  for  an  operator  performing  a  difficult 
task.  In  the  SSL  it  is  used  to  evaluate  how  a  single  person  can  operate  more  than 
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one  vehicle  at  a  time.  SCAMP  has  the  additional  advantage  of  requiring  little 
maintenance  and  being  easy  to  prepare  for  underwater  testing. 

SCAMP  is  a  28-inch  diameter  icosahexahedron  (26-sided)  object  weighing 
167  pounds  in  air.  About  each  of  its  three  axes,  SCAMP  has  a  pair  of  ducted 
fan  propellers,  shown  in  Figure  5.9.  A  pair  of  propellers  run  in  the  same  direc¬ 
tion  provides  translation  and  run  in  opposing  directions  provides  rotation  about 
its  associated  axis.  There  is  an  on-board,  closed-loop  motor  controller  for  each 
propeller  that  linearly  converts  an  8-bit  (-128  to  +127)  command  sent  to  the 
motor  into  a  propeller  speed.  All  on-board  processing  is  done  using  a  Motorola 
68HC11  microcomputer.  The  Motorola  68HC11  communicates  with  the  control 
station  by  means  of  a  message-based  serial  protocol  developed  at  the  SSL.  Data 
is  transmitted  over  a  fiber  optic  link.  The  control  station  consists  of  a  Macintosh 
Ilfx  computer  and  two  hand  controllers  (joysticks).  One  hand  controller  is  used 
for  translation  and  the  other  for  rotation.  SCAMP  also  has  a  7  lbs  lead-weight 
pendulum  that  is  located  below  the  center  of  SCAMP  along  the  yaw  axis.  The 
pendulum  remains  fixed  with  respect  to  the  coordinate  axes  fixed  on  the  vehicle 
unless  it  is  actuated  to  control  pitch.  But  for  the  pendulum,  video  camera,  and 
the  internal  electronics,  SCAMP  is  essentially  a  symmetric  rigid  body. 

In  the  experiments  described  here,  SCAMP  was  used  to  test  the  algorithms  of 
Section  5.2  which  provide  open-loop  controls  to  drive  a  vehicle  without  the  aid  of 
an  operator.  For  these  tests,  the  hand  controllers  were  bypassed.  Instead  control 
signals  were  computed  on  the  Macintosh  computer  using  Algorithm  1  and  sent 
directly  to  the  propeller  motors.  The  main  objective  of  the  experiments  was  to 
show  how  Algorithm  1  can  be  used  to  control  the  attitude  of  SCAMP  even  in 
the  event  of  an  actuator  failure.  We  assumed  that  the  yaw  propellers  had  failed. 
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Figure  5.10:  Calibration  Data  for  SCAMP. 


Then,  we  applied  the  open-loop  controls  from  Algorithm  1  to  actuate  only  the 
roll  and  pitch  propellers  to  drive  SCAMP  with  a  net  yaw  rotation. 

For  our  experiments  we  used  the  fact  that  due  to  the  drag  of  the  water,  a 
constant  propeller  speed  corresponds  to  a  constant  vehicle  speed.  As  a  result, 
a  constant  8-bit  command  sent  to  the  motor  corresponds  to  a  constant  vehicle 
speed.  Calibration  data  to  determine  the  relationship  between  the  8-bit  motor 
command  units  and  vehicle  angular  velocity  is  plotted  in  Figure  5.10.  The  data 
for  the  8-bit  commands  of  +127  and  -128  was  provided  from  previous  testing. 
The  other  data  points  were  obtained  at  the  time  of  the  experiments  described 
here.  A  constant  8-bit  signal  was  sent  to  the  yaw  propellers  for  a  period  of  60 
seconds.  Angular  velocity  was  measured  by  counting  the  number  and  direction 
of  rotations  during  the  60  second  period.  For  the  purposes  of  the  experiments 
we  assumed  that  vehicle  angular  velocity  is  linearly  related  to  the  8-bit  motor 
command  signal.  Based  on  the  data  in  Figure  5.10,  we  assumed  a  proportionality 
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constant  of  163  motor  command  units  per  rad/sec. 


We  note  that  there  is  a  time  delay  for  the  vehicle  speed  to  follow  the  mo¬ 
tor  command  related  to  the  natural  frequency  of  the  vehicle.  Because  of  the 
symmetry  of  the  vehicle,  we  assumed  that  this  delay  is  the  same  for  roll,  pitch 
and  yaw.  The  open-loop  controls  generated  by  Algorithm  1  are  sinusoids.  Pre¬ 
scribed  secular  motion  in  depth-one  bracket  directions  is  a  function  of  the  phase 
difference  between  the  sinusoids.  For  our  experiments  we  used  sinusoidal  control 
signals  with  frequencies  less  than  the  natural  frequency  of  the  vehicle.  Further, 
we  counted  on  the  fact  that  equal  time  delays  in  all  of  the  sinusoidal  control 
signals  should  not  upset  their  phase  relationships. 

The  kinematics  of  SCAMP  can  be  described  by  equation  (3.13)  of  Section  3.3 
for  an  underwater  vehicle.  Since  we  consider  only  the  attitude  control  problem 
for  SCAMP,  ignoring  the  translational  control  problem,  the  kinematics  reduce 
to  the  system  on  G  =  50(3)  defined  by  (3.2)  of  Section  3.1.  Based  on  the 
above  discussion  we  can  let  O,  =  eut,  i.e.,  the  angular  velocities  are  our  small- 
amplitude  controls.  When  the  yaw  propellers  are  inactive,  the  motion  control 
problem  becomes 

X  =  eX(uiAi  +  u2A2),  (5.30) 

where  X(t)  G  50(3),  {A\,  A2,  A3}  is  the  standard  basis  for  so(3)  and  eui(t) 
and  eu2(t)  are  roll  and  pitch  angular  velocities  (equivalently  the  8-bit  motor 
commands  to  the  roll  and  pitch  propellers),  respectively. 

System  (5.30)  is  a  depth-one  bracket  system  on  50(3)  where  n  =  3,  m  =  2, 
identical  to  the  spacecraft  example  with  two  controls  described  in  Section  5.2. 
Thus,  we  use  the  controls  of  (5.23)  specified  by  Algorithm  1  to  control  the  attitude 
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of  SCAMP.  For  a  pure  yaw  rotation,  i.e.,  ryjl  =  7 /2  =  0,  7/3  ^  0,  these  controls 
become 

eui(t)  =  cqu;  sin  u;/  0  <  t  <  t3 


0  0  <  t  <  ti 

cu2(t)  —  ^  ot2u)  sin(u)(t  —  ti))  t\  <  t  <  t2 
0  t2<t<t3 

where  T  =  t3  =  T/4,  t2  =  t\  +  MT ,  t3  =  t2  +  3T/4.  a!i,a!2  should  be 


selected  such  that 


a2 


7/3 

a\TT  M 


(5.31) 


For  the  experiments  we  chose  e  =  0.4,  |o;i|  =  0.4,  |a2|  =  0.4,  u  =  7r/4  rad/s 
and  M  =  6.25.  From  this  we  can  compute  T  =  8  s,  ii  =  2  s,  t2  —  52  s,  t3  =  58  s. 
Further,  from  (5.31)  7/3  =  Oi\a.2irM  =  ±7r  rad.  Thus,  we  expected  to  see  a  net 
yaw  rotation  of  ±180  degrees  within  0(e2)  accuracy  or  within  about  ±10  degrees 
accuracy,  e  was  chosen  to  be  relatively  large  so  that  the  oscillations  of  the  vehicle 
would  be  large  enough  to  observe  and  the  test  would  not  be  too  time  consuming, 
i.e.,  tf  =  t3  relatively  small.  The  fact  that  M  was  not  chosen  to  be  an  integer 
implies  that  there  should  be  a  small  net  rotation  about  the  roll  and  pitch  axes 
at  t  —  tf.  However,  the  passive  effect  of  the  pendulum  was  expected  to  quickly 
remove  these  rotations. 


Several  repetitions  of  this  experiment  were  run  in  May  and  June  1994.  Sensors 
were  not  available  to  take  velocity  or  position  measurements  during  the  experi¬ 
ments.  However,  many  of  the  experiments  were  recorded  on  videotape.  During 
these  experiments  SCAMP  was  observed  to  make  a  net  yaw  rotation  consistently 
as  expected.  Gentle  oscillations  about  the  roll  and  pitch  axes  were  clearly  visible 
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throughout  the  experiments  with  no  significant  final  net  roll  or  pitch  rotation. 
When  0:10:2  >  0,  SCAMP  was  observed  to  rotate  about  the  yaw  axis  in  the 
counter  clockwise  direction  (looking  from  above).  When  O1O2  <  0,  SCAMP  was 
observed  to  rotate  about  the  yaw  axis  in  the  clockwise  direction  (looking  from 
above).  The  net  yaw  rotation  was  typically  slightly  less  than  180  degrees  but 
within  the  accuracy  of  the  predicted  motion. 

For  one  series  of  the  experiments  with  0:10:2  <  0  (i.e.,  clockwise  yaw  motion) 
towards  the  end  of  the  experimentation,  the  net  yaw  rotation  was  not  quite  as 
high  as  expected  (closer  to  90  degrees  than  180  degrees).  This  may  have  been 
due  to  error  in  the  approximation  of  the  motor  command  to  velocity  conversion 
or  to  asymmetry  in  the  roll  and  pitch  propellers  in  this  direction  such  that  the 
phase  difference  between  these  signals  was  affected.  Additionally,  there  was  some 
difficulty  keeping  SCAMP  neutrally  buoyant  throughout  the  test,  but  this  did 
not  seem  to  have  an  effect  on  the  attitude  motion. 

In  summary,  attitude  control  of  the  underwater  vehicle  SCAMP  with  inactive 
yaw  propellers  was  experimentally  demonstrated  using  the  open-loop  controls 
derived  from  Algorithm  1.  The  experiments  were  useful  in  illustrating  both  the 
principle  of  the  control  design  of  this  chapter  as  well  as  the  potential  for  open-loop 
motion  control  based  on  the  algorithms  of  Section  5.2.  In  particular,  the  experi¬ 
ment  illustrated  Lie  bracket  effects  through  sinusoidal  controls  (in  this  case,  roll 
and  pitch  propeller  thrust  reversals).  The  experiment  did  not  involve  precision 
measurements;  however,  one  could  do  so  in  future  experimentation. 
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Chapter  6 


Application  to  Bilinear  Systems 


In  this  chapter  we  consider  the  problem  of  control  synthesis  for  bilinear  systems 
on  9?n.  The  theory  derived  in  this  dissertation  is  relevant  to  this  type  of  control 
problem  because  the  state  transition  matrix  for  a  bilinear  system  on  5?n  evolves  on 
a  subgroup  of  GL(n),  i.e.,  on  a  matrix  Lie  group  G.  Further,  the  state  transition 
matrix  equation  is  a  right-invariant  system  on  G  (possibly  with  drift)  of  the  form 
(2.7).  Thus,  we  can  express  the  control  problem  for  a  bilinear  system  on  $Rn 
equivalently  as  a  motion  control  problem  on  G. 

Our  goal  is  to  generate  controls  to  solve  the  original  control  problem  on  Un 
by  solving  the  equivalent  motion  control  problem  on  G,  i.e.,  by  driving  the  state 
transition  matrix  as  necessary.  We  first  examine  the  evolution  of  the  state  tran¬ 
sition  matrix  for  periodically  time-varying  controls  by  applying  the  theory  of 
averaging  on  Lie  groups  derived  in  Chapter  4.  Then,  we  consider  generating  con¬ 
trols  based  on  the  formulas  for  average  solutions  to  the  state  transition  matrix 
equation.  If  the  matrix  equation  is  not  drift-free,  as  is  the  case  in  the  example  we 
study  in  this  chapter,  we  cannot  generate  open-loop  controls  using  the  algorithms 
of  Chapter  5.  However,  we  can  use  the  same  basic  idea  of  driving  the  average 
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matrix  solution  exactly  in  order  to  drive  the  actual  solution  approximately. 

To  illustrate  the  application  of  our  theory  to  bilinear  systems,  we  study  a 
control  problem  for  switched  electrical  networks.  The  switched  networks  of  in¬ 
terest  have  bilinear  state-space  models  in  which  each  component  of  the  control 
u,  representing  the  position  of  a  switch,  takes  value  in  the  set  {0, 1}  at  any  given 
time.  Brockett  and  Wood  [78,  17]  have  shown  that  a  class  of  switched  electrical 
networks  such  as  those  used  in  power  conversion  applications  can  be  modelled  as 
bilinear  systems  with  state  transition  matrices  evolving  via  right-invariant  sys¬ 
tems  with  drift  on  the  Lie  group  SO(k)  or  SE(k).  The  control  problem  that 
we  study  is  that  of  transferring  energy  between  dynamic  storage  elements  in  a 
lossless  network  according  to  a  prescribed  path.  We  assume  that  we  can  control 
the  switching  in  a  periodic  way  with  small  (e)  period  (which  is  equivalent  to  small 
(e)  amplitude  in  scaled  time). 

Switched  electrical  networks  play  an  important  role  in  a  variety  of  systems, 
most  notably  in  power  converters  such  as  dc-dc  switchmode  power  converters. 
These  power  converters  in  turn  are  of  great  value  in  many  growing  application 
areas  such  as  in  communication  and  data  handling  systems,  portable  battery- 
operated  equipment,  and  uninterruptable  power  sources  (see  [67]).  New  require¬ 
ments  for  higher  performance,  smaller  volume  and  lighter  weight  power  converters 
make  new  demands  on  technology  and  warrant  a  fresh  look  at  associated  control 
strategies. 

In  standard  practice,  switching  strategies  (pulse-width-modulated  controls) 
are  derived  based  on  state-space  averaging  methods.  The  averaging  in  this  con¬ 
text  can  be  interpreted  as  first-order  (i.e. ,  0(e))  averaging,  meaning  that  the 
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solution  to  the  averaged  system  approximates  the  actual  system  solution  with 
0(e)  accuracy.  Thus,  increased  accuracy  is  achieved  with  decreased  e  which  cor¬ 
responds  to  a  higher  switching  frequency.  In  our  averaging  approach  we  consider 
higher-order  (i.e.,  0(e9),  q  >  1)  averaging.  This  gives  us  the  means  to  increase 
accuracy  by  increasing  q  rather  than  decreasing  e.  Thus,  we  can  improve  perfor¬ 
mance  without  requiring  excessively  high  switching  frequencies.  In  their  work  on 
switched  electrical  networks,  Brockett  and  Wood  [17]  derive  high-order  approxi¬ 
mations  of  the  state-space  equations  using  a  truncation  of  the  Campbell-Baker- 
Hausdorff  formula  for  the  logarithm  of  the  product  of  exponentials.  Our  work 
provides  a  justification  via  averaging  theory  on  Lie  groups  for  their  formula. 

Sira-Ramirez  [70]  has  developed  a  very  clear  and  simple  controller  design 
methodology  for  switched  electrical  networks  which  is  based  on  variable  structure 
systems  theory  and  sliding  regimes.  In  his  work,  control  is  achieved  using  feedback 
based  on  surprisingly  simple  laws  (requiring  as  little  as  one  bit  of  information). 
Our  controller  design  methodology,  on  the  other  hand,  focuses  primarily  on  open- 
loop  control,  although  feedback  can  be  added  for  robustness.  One  advantage  of 
open-loop  control  is  that  energy  transfers  in  the  networks  can  be  accomplished 
in  a  predictable,  finite  number  of  switchings.  This  eliminates  the  possibility  of 
chattering  which  is  sometimes  associated  with  sustaining  motion  on  a  sliding 
regime. 

In  Section  6.1  we  define  the  general  switched  electrical  network  and  describe 
our  network  example  which  is  modelled  as  a  bilinear  system  with  a  state  transition 
matrix  that  evolves  on  50(3).  In  Section  6.2  we  apply  averaging  theory  and  study 
controllability.  In  Section  6.3  we  describe  our  controller  design  for  the  example. 
Simulation  results  are  also  presented. 
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6.1  Switched  Electrical  Network  Problem  and 


Approach 

The  (idealized)  state-space  bilinear  equations  for  switched  electrical  networks 
generally  take  the  form  [78,  17]: 

x  =  (Ao  +  A\U\  +  A2U2  +  •  •  •  +  Amum)x  -f-  (bi Ui  +  62^2  +  ■  •  •  +  bmum).  (6.1) 

The  state  x  G  5Rn  represents  inductor  currents  and  capacitor  voltages.  Each 
control  Ui(t)  €  {0, 1}  represents  the  position  of  a  switch  at  time  t.  Typically, 
the  network  will  have  only  one  switch  or  a  set  of  switches  that  change  position 
synchronously  such  that  control  action  can  be  represented  by  a  single  switch 
position  u,  also  taking  values  in  the  set  {0, 1}.  The  vectors  bi,...,bm  represent 
constant  power  sources.  We  can  always  express  system  (6.1)  as  a  homogeneous 
equation  using  the  fact  that 

x  =  (Ax  +  b)u 

is  equivalent  to 


The  state-space  equations  of  interest  thus  become 

x  =  (A  +  Bu)x.  (6.2) 

Alternatively,  we  can  write  (6.2)  as 

x  =  (A(l  —  u)  +  (A  +  B)u)x.  (6.3) 

In  changing  the  switch  from  the  position  corresponding  to  u  =  0  to  the 
position  u  =  1,  the  network  topology  changes.  This  is  reflected  in  (6.3)  as  a 


158 


change  between  two  different  linear  system  descriptions,  i.e.,  x  =  Ax  when  u  =  0 
and  x  =  (A  +  B)x  when  u  —  1.  Thus,  these  are  bilinear  systems  which  always 
have  a  drift  term,  i.e.,  nontrivial  dynamics  when  u  —  0. 

From  linear  systems  theory  it  is  well  known  that  the  state  transition  matrix 
$(t)  G  GL(n)  which  describes  the  evolution  of  the  state  according  to 

x(t)  =  <3>(t):r(0)  (6.4) 

satisfies  the  same  equation  (6.2)  as  x,  i.e., 

$  =  (A  +  Bu)$,  $(0)  =  I.  (6.5) 

It  is  also  well  known  [11]  that  $(t)  will  evolve  on  the  matrix  Lie  group  G  associ¬ 
ated  with  the  Lie  algebra  generated  by  A  and  B  (the  connected,  simply-connected 
covering  group).  Equation  (6.5)  describes  a  right-invariant  system  with  drift  on 
the  Lie  group  G.  If  we  define  X  =  $_1  €  G  then,  using  the  identity 

=  -K-'(t)k(t)K-'(t) 

for  K(t)  annxn  matrix,  we  see  that  X  satisfies 

X  =  X{-A  -  Bu ).  (6.6) 

Equations  (6.6)  describes  a  left-invariant  system  with  drift  on  the  Lie  group  G. 
Considering  the  alternative  system  description  of  (6.3)  and  defining  Ai  —  A, 
A2  =  A  +  B,  u\  =  —  (1  —  u)  and  U2  =  —  u  we  get 

X  =  X(A\U\  +  A2U2),  (6-7) 

which  looks  like  system  (2.11)  without  the  e  factor.  We  have  disguised  the  fact 
that  the  system  has  a  drift  term  by  defining  two  controls  which,  in  fact,  are 
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u 


Figure  6.1:  Network  Example 

not  independent.  However,  by  transforming  our  system  into  the  form  (6.7),  we 
can  apply  our  averaging  theory  on  Lie  groups  to  determine  high-order  average 
approximations  to  the  behavior  of  X  and  thus  $. 

We  address  the  problem  of  specifying  switching  controls  that  drive  the  state 
of  the  bilinear  system  (6.2)  from  some  initial  condition  Xi  along  a  desired  path 
to  a  final  condition  xj.  We  approach  the  switching  problem  by  choosing  k  target 
points  xi,...,Xk  between  Xi  and  xj  along  the  desired  path.  We  then  specify 
open-loop  switching  controls  to  drive  the  state  between  successive  target  points. 
Feedback  can  be  added  (possibly  intermittently)  for  robustness.  From  equation 
(6.4),  the  problem  of  controlling  the  evolution  of  x(t)  can  be  considered  as  a  prob¬ 
lem  of  controlling  the  evolution  of  $(t)  (or  alternatively  X(t)).  As  in  Chapter  5, 
we  determine  the  switching  control  that  will  drive  an  average  approximation  of 
$(i)  exactly  as  desired  in  order  to  drive  $(i)  approximately  as  desired. 

The  network  example  that  we  study  in  this  chapter  is  shown  in  Figure  6.1. 
This  simple  network  can  be  considered  as  a  model  of  the  conversion  portion  of 
a  dc-dc  voltage  converter  [78].  The  control  problem  is  to  convert  energy  from 
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one  capacitor  to  the  other  via  the  inductor.  For  example,  suppose  that  at  t  —  0, 
Vi(0)  =  Vio,  h{0)  =  0  and  V^O)  =  0.  By  appropriate  switching,  the  energy  in 
C\  can  be  transfered  to  C2  so  that  at  some  later  time  t',  V\ (t1)  =  0,  J3(f')  =  0  and 
V2  (t')  =  Vi .  The  ratio  V2  /V10  will  depend  on  the  ratio  of  the  capacitances  C\/Ci 
so  that  voltage  scaling  up  or  down  can  be  achieved  with  an  appropriate  choice 
of  capacitors.  Of  particular  interest  is  controlling  the  energy  transfers  in  this 
network  to  meet  certain  performance  criteria.  In  Section  6.3  we  design  controls  to 
transfer  energy  between  capacitors  while  maintaining  a  constant  nonzero  current 
/3  through  the  inductor. 

The  equations  for  this  network  are 

C1V1  =  (1  ~u)h 

C1V1  =  uls  (6.8) 

L3/3  =  -(1  -u)Vi-uV2. 

Define  the  state  vector  of  the  network  x  —  ( xi,xi,xz)T  by  x\  =  \fC\V\,  x2  — 
\fCiVi,  x3  =  yZ^/3,  and  let  u)\  —  1/ \JC\Lj,  and  u>2  =  l/\ZC2L3.  Then  (6.8)  can 
be  rewritten  as 


x  =  ( UJ1A1  -  (u>i A2  +  co2Ai)u)x 

=  (a;i^42(l  -u)  —  uj2Aiu)x  (6.9) 

-  (-U1T1  -  u2A2)x 

where  iq  =  tu2u,  u2  —  —cui(l  —  u)  and  {Ai,  A2,  A3}  is  the  standard  basis  for  so(3). 
Since  [Ai,A2]  =  A3,  the  Lie  algebra  generated  by  A\  and  A2  is  so(3).  Thus,  the 
state  transition  matrix  $(t)  evolves  on  the  Lie  group  50(3)  and  the  control 
problem  for  system  (6.9)  can  equivalently  be  stated  as  a  motion  control  problem 
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r  r  =  0(e) 


Figure  6.2:  Switching  Control 

on  50(3).  Since  an  orthogonal  matrix  acting  on  a  vector  in  9fJ3  preserves  length, 
x(t)  evolves  on  a  sphere  in  5R3.  This  confirms  that  the  energy  of  the  system, 
\xTx,  is  conserved. 

The  network  of  Figure  6.1  is  representative  of  a  class  of  interesting  networks. 
With  an  increased  number  of  capacitors  and/or  inductors  in  the  network,  the 
state  will  evolve  on  a  higher  dimensional  sphere  and  the  transition  matrix  will 
evolve  on  a  higher  dimensional  orthogonal  group  SO(k).  If  power  sources  and/or 
loads  are  introduced  into  the  network  then  the  state  will  no  longer  evolve  on  a 
sphere  since  energy  may  be  added  to  or  dissipated  from  the  network.  In  some 
of  these  cases  it  can  be  shown  that  the  state  transition  matrix  evolves  on  the 
Euclidean  group  SE(k)  [78]. 

6.2  Averaging  and  Controllability 

The  relevant  controls  for  switched  electrical  networks  are  illustrated  in  Figure  6.2. 
These  controls  have  nonzero  mean  and  have  0(1)  amplitude  and  0(e)  period 
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whereas  the  controls  of  system  (2.9)  studied  in  Chapter  4  have  0(e)  amplitude 
and  0(1)  period.  By  scaling  time  in  the  averaging  theorems  of  Chapter  4,  we  can 
derive  the  appropriate  average  formulas  for  the  network  models.  The  following 
corollary  is  a  time-scaled  version  of  Corollary  4.14  and  the  first  part  of  Corol¬ 
lary  4.16.  It  provides  0(e)  and  0(e2)  average  approximations  of  the  solution 
to 

m 

9  —  TeLg  ■  U(t),  tf(f)  =  2>(*)6,  g(t)eG,  U(t)  €  G,  (6.10) 

i= 1 

where  n  is  the  dimension  of  G,  m  <  n  and  the  controls  Ui  are  periodic  with  0(e) 
period  and  have  nonzero  mean.  We  use  T*),  uav,  u ,  Uav,  U ,  Area,ij(T )  and  oy(<) 
as  defined  by  (2.15),  (2.19)-(2.23),  respectively. 

Corollary  6.1  Consider  system  (6.10).  Assume  U(t)  and  6  are  as  in  Theorem  4.9 
and  U(t  +  T ')  =  U(t),  Vt  >  0  where  T'  =  0(e).  Let  <?(0)  =  g0  e  Q  C  G  and 
Z0  =  =  0(e).  Let  Z ^  =  T,k=izko^k  and  assume  that  \\Z0  -  z'f' ||  = 

0(e9),  q  =  1,  2.  Let 

zk\t)  =  uavkt  +  zk{o\  Z{1)(t)  =  J2  z£\t)tk,  =  ezW{t).  (6.11) 

fc= i 

If  Z<V(t)  £S,Vte  [0,6],  then 

d(g(t),g[1)(t))  =  0(e),  Vt  G  [0,6].  (6.12) 

Let 

772  72 

42  (*)  =  «*(*)+  it  aij(t)^'ij+zko\  ZW(t)  =  X)42](^fc»  ^[2l(t)  =  ezm{t). 

i,j=l\i<j  k=l 

(6.13) 

For  an  integer  N, 

772 

423(iVT')  =  NT'uavk  +  N  Arzal3{T')T %  +  zk(02).  (6.14) 
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r§,  Area,ij(T'),  aij(t)  are  defined  by  (2.15),  (2.22),  (2.23),  respectively.  If  Z^(t)  G 
S,  Vi  €  [0,  b],  then 

d(g(t),  g[2] (t))  =  0(e2),  Vt  G  [0,  b}.  (6.15) 


Proof:  Let  s  =  t/e,  then  ds  =  di/e  and  we  can  write  (6.10)  as 


da  m 

~r(es)  =  tTeLg{es)  •  U(es),  U(es)  =  ^Uj(es)^. 

as  i-  i 


Define 

V(s)  =  t/(es),  «i(s)  =  «i(es),  h(s)  =  #(es). 
Then  (6.16)  becomes 


(6.16) 


dh  m 

~(s)  =  eTeLh(s)  •  V(s),  V(s)  =  J>(«)&. 

i=l 

Since  w(t  +  T')  =  w(t)  then  v(s  4-  T)  =  v(s)  where  T  =  T'/e  =  0(1).  Define 


Note  that 
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Let 

y(1)(s)  =  eVms  +  41},  h^{s)  =  ey(1)^. 

By  Corollary  4.14,  if  yW(s)  €  S,  Vs  G  [0,  4>/e]  then 

d(h(s) ,  fi^(s))  =  0(e),  Vs  €  [0,6/e]. 

This  implies  that 

<*>(! ),hmO)=0(e),  Vi  e  [0,6], 

Recall  that  <?(t)  =  /i(|).  Let 

y{1)(t)  =  yW(f)  =  +  4l)  =  uavt  +  z$\ 

gW(t)  =  fc(D©  =ey(1)(t/£)=eza)(t). 
Thus,  if  ^0)(t)  e  S,vte  [0,6]  then 

d(ff(t)>ffw(t))  =  °(e)>  e  [M, 

proving  the  first  part  of  the  corollary. 


For  the  second  part  of  the  corollary  define 


Vk(s)  =  [  vk(a)da, 

Jo 

1  fs 

Ms)  =  2  y0  (^(<7)wi((T)  -  '6j(^)^(cr))dc7. 


Note  that 
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and 


Let 

m 

Vk\s )  =  ™k{s)  +  e2  Yj  ba(s)Tij  +  zko\ 

i,j=l-,i<j 


y[2](s)  =  ylk]{s)tk ,  h[2](s)  =  eYl2]{s). 

fc=i 

By  Corollary  4.16,  if  Y^s)  G  S,  Vs  G  [0,6/e],  then 


d(h(s),  hfi(s))  =  0(e2),  Vs  G  [0,6/e]. 


This  implies  that 

d(h(t),hM(t))=0(e2),  Vi  G  [0,6]. 

Let 

m 

zk](t)  =  yl ?0  =  ^fe(f)  +  e2  Y  +  ^o2) 

m 

=  uk(t)+  Y  <*»(*)*%  + Zko*  ■ 

i,j=l;i<j 

Z®(t)=  Y[2](\)  =  £  !/l2'(f)&  =  £ 

fc=l 

sW(t)  £  ft!2l(f)  =  e1'w«*>  =  ezPI<‘>. 

Thus,  if  Z^(i)  G  S,  Vi  G  [0,6],  then 

<%W,3I2,(0)  =  0(e2),  Vi  G  [0,6]. 
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Figure  6.3:  Geometric  Interpretation  of  Areauv(T') 

Following  the  proof  of  Corollary  4.16  for  N  an  integer,  uk(NT')  —  NT'uavk 
and  dij(NT')  =  N Area^T') .  So 

m 

zf{NT')  =  NT'uavk  +  N  Y,  Areal3(T')l%  +  □ 

It  is  straightforward  to  compute  the  relevant  terms  in  the  average  formulas 
of  Corollary  6.1  for  our  controls  in  Figure  6.2.  The  variable  fi,  where  0  <  [/,  <1, 
referred  to  as  the  duty  ratio ,  is  defined  as  the  fraction  of  the  period  V  for  which 
u  =  1.  If  we  only  concern  ourselves  with  moments  of  time  t  when  t  =  MT',  M 
an  integer,  then  it  is  irrelevant  when  during  a  period  u  =  1,  i.e.,  shifts  in  time 
have  no  effect  on  our  results.  Letting  v  =  1  —  u  we  find  using  definitions  of  uav 
(2.19)  and  Area,ij(T')  (2.22)  that 

Uav  =  V,  vav  =  1  -  //,  Areauv(T')  =  |T,2//(  1  -  fj).  (6.17) 

Figure  6.3  illustrates  the  geometric  interpretation  of  the  area  term  Areauv(T'). 

For  the  example  network  of  Figure  6.1,  we  have  by  (6.9)  that 

$  =  {-uiAi  -  u2A2)$,  $(0 )  =  / 

W  (6.18) 
X  =  X(u1Al+u2A2),  X(0  )=/ 
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where  Ai  =  e\,  A2  =  e2,  Ui  =  lo2u  and  u2  =  — 0^(1  —  u).  Thus,  from  (6.17) 
uavl  =  u2/i,  uav2  =  -uq(l  -  n),  Areai2{T')  = -\ujioj2T'2 ii{l  -  n). 

Therefore,  from  Corollary  6.1,  since  the  relevant  structure  constant  is  Tf2  =  1 
([Ai, ^2]  =  ^3)  the  average  state  transition  matrix  solutions  are 

$(1)(MT')  =  (X^)~\MT')  =  (6.19) 

41}(MT')  =  u2MT'(j,,  z£\MT')  =  -UiMT'i  1  -  fj),  zi]{MT')  =  0.  (6.20) 

$[2] (MT1)  =  (XM)-\MT')  =  e^*=i  (6.21) 

zf\MT ')  =  uj2MT'h,  z2\MT')  =  —u>iMT'(l  -  /*), 

42](MT')  =  -§u;1w2MT'2/i(l  -  /x). 

Towards  the  goal  of  controlling  the  state  transition  matrix  $(f),  we  examine 
the  controllability  of  the  system 

X  =  X(A  +  Bu)  (6.23) 

on  the  matrix  Lie  group  G  with  Lie  algebra  Q.  In  order  to  accommodate  switching 
controls,  as  shown  in  Figure  6.2,  we  define  the  class  of  controls  Us  as 

•  Us  is  the  class  of  piecewise  constant  functions  on  [0, 00)  taking  values  in 
where  components  of  its  elements  take  values  in  the  set  {0, 1}. 

We  have  the  following  corollary  to  Theorem  2.2  of  Jurdjevic  and  Sussmann. 

Corollary  6.2  Let  G  be  a  compact  and  connected  Lie  group.  System  (6.23)  is 
controllable  with  u  £  Us  if  and  only  if  the  Lie  algebra  L  generated  by  {A,  B}  is 
equal  to  Q.  Further,  At'  >  0  such  that  for  every  X0,Xi  £  G  there  is  a  control 
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u  E  Us  that  steers  X0  to  Xi  in  less  than  t'  units  of  time.  If,  further,  G  is  semi¬ 
simple,  then  3t'  >  0  such  that  for  every  X0,Xi  £  G  there  is  a  control  u  E  Ws  that 
steers  Xo  to  X\  in  exactly  t'  units  of  time. 

Proof:  Let  w  =  2u  —  1.  Then  w  =  1  if  u  =  1  and  w  =  —  1  if  u  —  0.  Thus,  if 
u  E  Us  then  w  E  Z4  ( Ub  defined  in  Section  2.2.1).  Since  u  =  ^(w  +  1),  system 
(6.23)  can  be  rewritten  as 

X  =  X(A  +  B(\(w  +  1)))  =  X((A  +  ifi)  +  iflw).  (6.24) 

By  Theorem  2.2  (Jurdjevic  and  Sussmann)  system  (6.24)  is  controllable  with 
w  £  Ub  if  and  only  if  the  Lie  algebra  Ls  generated  by  {(A  +  \B),  \B}  is  equal  to 
Q.  Since  Ls  is  L ,  system  (6.24)  with  w  e  Ub  is  controllable  if  and  only  if  L  =  Q. 
But,  system  (6.24)  with  w  eUb  is  equivalent  to  system  (6.23)  with  u  E  Us.  The 
remaining  results  follow  from  Theorem  2.2.  n 

For  our  example  network  (Figure  6.1),  the  state  transition  matrix,  which 
satisfies  equation  (6.18),  evolves  on  the  Lie  group  G  —  50(3)  which  is  connected, 
compact  and  semi-simple.  The  Lie  algebra  L  generated  by  {Ai,T2}  is  so(3). 
Thus,  by  Corollary  6.2  the  system  described  by  (6.18)  is  controllable.  Further, 
there  exists  a  time  t'  >  0  such  that  for  every  <50,  $i  £  50(3),  there  is  a  control 
u  E  IAS  that  steers  $o  into  in  exactly  t'  units  of  time. 

It  is  important  to  note  that  the  system  (6.18)  is  not  controllable  in  arbitrarily 
short  periods  of  time.  In  fact,  steering  from  some  $0  £  50(3)  to  some  other 
arbitrary  dq  E  50(3)  may  take  a  considerably  long  time.  Further,  $  may  have 
to  travel  far  to  reach  $i.  This  implies  that  we  may  not  be  able  to  choose  switching 
controls  to  follow  any  arbitrary  path  in  the  system  state  space. 
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Figure  6.4:  Paths  in  State  Space 


A  qualitative  picture  of  the  paths  that  we  can  follow  closely  can  be  deduced 
from  the  O(e)  average  formula  <E>(X)  for  $  given  in  equations  (6.19)  and  (6.20).  In 
Figure  6.4  we  show  the  state  space  for  our  system,  i.e.,  a  sphere  in  5ft3.  A  curve 
$(t)  corresponds  to  a  rotation  of  the  sphere.  While  the  xi,  X2,  X3  axes  stay  fixed, 
the  system  state  x(t )  rotates  with  the  sphere.  Equation  (6.19)  can  be  interpreted 
as  an  Euler  parametrization  of  the  rotation  which  approximates  the  rotation 
<3>.  Let  z^  =  (2^,  z£\  z^)T  and  note  that  z^(MT')  —  Mz^(T').  Let  <fi  = 
||zW(T,)||.  The  magnitude  of  the  rotation  is  M(f)  and  the  axis  of  rotation  is 
—z^(T')/<f).  Since  /x  is  defined  such  that  it  satisfies  0  <  /x  <  1,  equations  (6.19) 
and  (6.20)  imply  that  —z{1\T')  <  0,  —z^iT')  >  0  and  —  z^(T')  =  0.  Thus, 
the  axis  of  rotation  of  the  0(e)  approximation  will  point  into  the  quadrant  of 
the  X1-X2  plane  corresponding  to  X\  <0,  x2  >  0.  For  example,  if  /x  =  0  then 
corresponds  to  a  positive  rotation  about  the  X2-axis.  If  /x  —  1  then 
corresponds  to  a  negative  rotation  about  the  xi-axis. 
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In  general,  this  type  of  restriction  means  that  a  path  that  can  be  followed 
closely  in  one  direction  cannot  be  followed  closely  in  the  opposite  direction.  In 
the  next  section  we  will  illustrate  the  design  of  a  controller  that  transfers  energy  in 
the  example  network  from  C\  to  C2  following  the  path  PQRS  shown  in  Figure  6.4. 
The  path  from  P  to  Q  can  be  achieved  using  u  =  0  (i.e.,  /i  =  0).  Similarly,  the 
path  from  R  to  S  can  be  achieved  using  u  =  1  (i.e.,  /i  =  1).  The  path  from 
Q  to  R  can  be  followed  by  successive  rotations  about  different  vectors  pointing 
into  the  second  quadrant  of  the  X1-X2  plane.  On  the  other  hand,  the  reverse 
path  SRQP  cannot  be  followed  closely  due  to  the  limitation  on  the  direction  of 
achievable  rotations.  Similarly,  the  path  SR'Q'P  is  achievable  while  PQ'R'S  is 
not. 


6.3  Controller  Design 

In  order  to  design  a  controller  for  the  example  network  of  Figure  6.1,  we  first 
develop  a  technique  for  computing  the  control  switchings  that  will  drive  the  state 
x(t)  from  some  initial  target  point  xa  to  the  next  target  point  Xb.  We  assume  that 
the  path  from  xa  to  Xb  is  in  the  “achievable”  direction  as  discussed  in  Section  6.2. 
Let  the  switching  period  V  be  fixed  at  V  =  e.  Then  the  problem  becomes  one  of 
choosing  (j,  (the  duty  ratio)  and  M  (the  number  of  switching  periods)  such  that 
for  some  initial  time  to,  x(to)  =  xa  and  x(to  +  MT ')  =  Xb- 

Using  our  second-order  average  formula  ((6.21)  and  (6.22)),  we  know  the 
state  transition  matrix  solution  as  a  function  of  fj,  and  M  with  0(e2)  accuracy. 
To  determine  the  desired  motion  of  the  state  transition  matrix,  we  parametrize 
the  various  rotations  that  will  take  xa  into  Xb  as  a  function  of  a  single  parameter. 
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One  rotation  that  will  take  xa  into  x b  can  be  computed  as 


<f>c  =  e9xc  where  9  =  cos  1(x^xb),  xc  = 


xa  x  xb 
xa  x  xb 


xaxb 

X*Xb\\' 


(6.25) 


After  this  rotation  has  been  performed,  the  state  is  invariant  to  rotations  about 
the  vector  xb.  A  class  of  rotations  <3?^  that  will  take  xa  into  xb  is  described  by 


db&b 


(6.26) 


where  9b  is  a  free  parameter.  Our  goal  is  then  to  compute  /x,  M  and  9b  such 
that  <3>[2](MT')  =  $0().  We  describe  two  methods.  The  first  method  is  based  on 
quaternions  and  it  produces  a  set  of  nonlinear  algebraic  equations  to  be  solved  for 
the  exact  values  of  /x,  M  and  9b.  The  second  method  uses  some  approximations 
to  produce  a  linear  set  of  equations  to  be  solved  for  /x,  M  and  9b. 


Method  1  (quaternions).  A  unit  quaternion  is  a  four-tuple  that  can  be  used  as 
a  representation  of  a  rotation  in  K3.  Quaternions  are  easily  multiplied  making 
the  computation  of  a  product  of  rotations  as  in  (6.26)  straightforward.  Let  Qc  = 

{Qco  >  Qci  )  Qc2  )  Qc3  )  )  Qb  (%0  J  Qbl  )  Qb2  )  9&3  )  >  Qt  (?to  )  Qtl  1  Qt2  1  Qt$)  > 

Qz  =  (Qz0:Qz1,Qz2jQz3)  be  the  quaternion  representations  of  $c,  =  e8bXb,  $Qb  — 

$l2l(Mr'),  respectively.  Then,  by  definition 


Qc 

Qb 

Qz 


,  9  .9  .9  .  9 . 

(cos  -,xCl  sin  xC2  sin  -,xC3  sin  -), 

/  9b  .  9b  .  9b  .9b 
(cos  — ,  xbl  sin  — ,  xb2  sin  — ,  xb3  sin  — ) , 


(cost  421(MT')  0  *  gjlg)  j 

C0S  2 ’  <t>  2’  4>  2’  <t>  Sm  2  ’ 


J2!/ 


J2!/ 


(6.27) 


where  4>  —  \\z^(MT')\\.  By  the  rules  of  quaternion  multiplication  [10],  Qt  —  QbQc 
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such  that 


9&0  9c 0  Qbi  Qci  %2  Qc2  %3  9c 3 
QboQci  “I-  QbiQco  T  9 bj 9c3  9639c2 
qboqc2  +  qb2qCQ  +  9639Ci  -  qbl qC3 
QboQcs  “I"  9639c0  "F  96i9c2  962  9ci 


To  find  /z,  M  and  0*,  such  that  $^(MT')  =  $06,  we  solve  Qt  —  Qz.  Because 
we  consider  unit  quaternions,  we  have  three  independent  equations  and  three 


unknowns. 


Method  2  (linear  approximation).  For  9b  and  9  small,  by  the  Campbell-Baker- 
Hausdorff  formula  [54], 

<J>06  =  edbXbe8xc  —  ew, 

w  =  9bxb  +  9xc  +  9b9[xb,  xc]  +  ~9b92[[xb,  xc],xc]  +  ^0£0pc,  xb],xb]  +  . . . 

We  make  an  approximation  of  w  linear  in  9b  by  ignoring  the  bracket  terms  of 
higher-order  than  single  brackets.  We  use  the  identity 

[a,  b]  =  ab  —  ba  =  a  x  b  =  ab, 

and  let  Xd  =  xbxc.  Then  we  find  that 

w  «  9bxb  +  9xc  +  9b9xd  —  9b(xb  +  9xd )  +  9xc. 

Now  let  r  =  M^i.  From  (6.21)  and  (6.22),  $I21(MT')  fa  e&  where 
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To  find  fj,,  M  and  9b  we  solve  w  =  y.  This  yields  three  linear  equations  in  the 
three  unknowns  r,  M  and 


( 

o>2e 

uqe 

^  -\ux co2e2 

We  can  then  solve  for  /x 


(a*!  +0xAl)  ^ 

(  \ 
r 

-0xCl  ^ 

( xb2  +0xd2) 

M 

= 

-9xC2 

(xb3  +  0xd3)  ) 

V  6b  ) 

v  ~9xC3  } 

=  r/M. 


We  can,  of  course,  improve  the  accuracy  in  the  computation  of  M,  y,  and 
6b  for  Method  2  by  including  nonlinear  terms  in  the  expressions  for  w  and  y. 
The  linear  approximation,  however,  is  useful  because  it  reduces  computational 
complexity.  This  would  be  an  advantage  if  the  computation  were  to  be  done 
on-line  for  feedback. 


Example  Problem.  We  illustrate  a  controller  design  example  based  on  Method 
1.  Suppose  that  it  is  desired  to  transfer  energy  from  C\  to  C2  while  maintaining 
a  constant  current  /3  through  the  inductor.  That  is,  suppose  we  wish  to  drive 
the  state  x(t)  along  the  path  PQRS  as  shown  in  Figure  6.4.  Let  xTx  —  1,  i.e., 
assume  that  x(t)  evolves  on  the  unit  sphere.  Then  we  want  x(0)  =  P  =  (1, 0, 0)T 
and  x(tf)  =  S  =  (0,-1, 0)T.  Let  us,  for  example,  choose  the  constant  current 
such  that  x3  =  — 1/\/2.  Then  we  want  x(so)  =  Q  =  (l/\/2, 0,  —  l/\/2)T  and 
x(sf )  =  R  =  (0,  —l/y/2,  —  l/\/2)r.  We  choose  six  target  points  xx,. .  .,xe  along 
the  path  from  xo  =  Q  to  X7  —  R  as 

xt  =  e-te^Xi-u  i  —  1, ...  ,6. 

We  assume  the  values  for  the  network  components  are 

Cx  =  0.1,  C2  =  0.2,  U  =  0.5. 
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We  note  that  the  path  from  P  to  Q  is  a  rotation  of  cos-1(l/\/2)  =  7t/4  radians 
about  the  X2-axis.  We  can  follow  this  path  by  setting  u  =  //  =  0  for  t  €  [0,  s0] 
where  so  is  computed  from 

WlS0(l  -  aO  =  UJlSo  =  7t/4. 

Similarly,  the  path  from  R  to  S  is  a  rotation  of  — 7t/4  radians  about  the  xi-axis. 
This  path  can  be  followed  by  setting  u  =  fi  =  1  for  t  6  [s/,t/]  where  tf  —  sj  is 
computed  from 

~U2 (tf  -  Sf)n  -  -U2(tf  -  Sf)  =  7T / 4. 

To  compute  the  switching  control  for  the  path  QR,  we  apply  Method  1  to 
each  of  the  seven  steps  to  be  taken  between  Q  and  R.  Let  and  denote 
the  values  of  fi  and  M,  respectively,  to  be  used  to  drive  x(t)  from  Xi  to  xj.  Using 
€  =  0.01,  Method  1  (solved  numerically  using  MATLAB)  produces 


ij 

01 

12 

23 

34 

45 

56 

67 

Pij 

0.9262 

0.8016 

0.6924 

0.5858 

0.4705 

0.3310 

0.1374 

Mij 

7.5781 

8.3375 

8.6737 

8.5677 

8.0238 

7.0701 

5.7569 

Thus,  Sf  =  s0  +  Mj(i+i)e  =  so  +  54.0078e.  We  note  that  the  values  of 
are  not  integers.  We  account  for  that  by  using  a  fractional  period  (i.e. ,  a  scaled 
value  of  T')  for  the  last  switching  of  each  step. 

The  control  u  computed  for  the  complete  path  PQRS  is  shown  in  Fig¬ 
ure  6.5(b).  This  figure  shows  that  there  are  a  finite  number  of  control  switchings. 
The  duty  ratio  is  close  to  1  towards  the  beginning  and  close  to  0  towards  the 
end.  Figure  6.5(a)  shows  the  response  of  the  state  x(t)  as  a  function  of  time.  The 
desired  energy  transfer  can  be  observed,  i.e.,  x\  goes  from  1  to  0  and  x2  goes  from 
0  to  -1.  £3  ramps  to  — 1/ \/2,  stays  there  and  then  ramps  back  to  0  as  desired. 
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Figure  6.5:  Control  Signal  and  State  Response 

The  trajectory  of  x(t)  in  the  state  space  is  illustrated  in  Figure  6.6.  The  simu¬ 
lation  was  performed  using  MATLAB.  We  show  a  magnified  plot  of  x3(t)  during 
the  path  QR  in  Figure  6.7.  The  root-mean-square  error  in  x3(t)  during  the  path 
QR  when  it  was  intended  to  be  constant  at  x3(t)  =  —l/y/2  was  computed  to  be 
0.0037  =  37e2.  This  is  consistent  with  the  0(e2)  accuracy  that  we  expect. 

Increases  in  accuracy  could  be  achieved  either  by  decreasing  e  (increasing 
switching  frequency)  or  by  considering  higher-order  terms  in  the  average  approx¬ 
imation  of  $(t).  Feedback  could  be  introduced  for  robustness  by  computing  // 
and  M  on  line  after  each  or  every  few  target  points  are  reached.  As  explained 
above,  Method  2  might  be  more  suitable  for  feedback  since  it  requires  solving  a 
linear  rather  than  a  nonlinear  set  of  algebraic  equations. 

The  network  that  is  the  topological  dual  to  this  example  is  also  described  by 
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a  state  transition  matrix  that  evolves  on  50(3)  [70].  Accordingly,  the  method¬ 
ology  described  here  can  be  used  to  control  energy  transfers  in  the  dual  net¬ 
work.  Similarly,  it  is  expected  that  one  could  extend  the  methodology  to  other 
more  complicated  networks  such  as  those  with  a  state  transition  matrix  evolving 
on  SO(k),  k  >  3.  The  major  difficulty  with  such  an  extension  would  be  the 
parametrization  of  the  rotations  in  SO(k)  that  drive  the  state  from  one  point  to 
another  on  the  sphere  in  3fJfe. 
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Chapter  7 


Conclusions  and  Future  Research 


Motion  control  problems  were  considered  in  this  dissertation  in  the  framework 
of  systems  on  finite-dimensional  Lie  groups.  One  goal  of  this  study  was  to  un¬ 
derstand  the  behavior,  or  motion,  of  these  systems  given  small-amplitude,  peri¬ 
odically  time-varying  control  inputs.  A  second  goal  was  to  address  the  problem 
of  control  synthesis.  Averaging  theory  proved  to  be  a  very  useful  tool  in  this 
investigation.  Our  success  in  deriving  simplified,  geometric  formulas  for  average 
motion  and  the  generalized  nature  of  our  methodology  for  control  synthesis  pro¬ 
vides  evidence  for  our  initial  assertion  that  Lie  groups  provide  both  a  natural 
and  a  rich  setting  for  studying  a  variety  of  motion  control  problems.  Some  of  the 
contributions  of  this  dissertation  are  outlined  below. 

In  Chapter  2  we  described  the  abstract  framework  of  motion  control  on  Lie 
groups.  We  cited  two  important  local  representations  of  the  solution  to  a  left- 
invariant  system  on  a  finite-dimensional  Lie  group  for  use  in  our  averaging  theory 
on  Lie  groups.  We  extended  the  applicability  of  the  product  of  exponentials 
representation  (Wei  and  Norman)  from  systems  on  matrix  Lie  groups  to  systems 
on  abstract  finite-dimensional  Lie  groups.  We  also  applied  a  result  of  Lazard  and 
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Tits  on  the  injectivity  of  the  exponential  map  to  show  that  the  single  exponential 
representation  (Magnus)  of  solutions  on  certain  Lie  groups  have  reasonably  large 
domains. 

In  Chapter  3  we  showed  how  to  express  several  example  motion  control  prob¬ 
lems  as  drift-free,  left-invariant  control  systems  on  matrix  Lie  groups.  The  ex¬ 
amples  are  all  kinematic  control  problems  for  mechanical  systems  in  that  the  Lie 
group  in  each  example  is  the  system  configuration  space,  the  differential  equation 
on  the  Lie  group  describes  the  kinematics  and  the  system  velocity  was  taken  to 
be  the  control  input.  For  the  spacecraft  attitude  control  problem,  we  described 
two  different  physical  arrangements,  one  using  internal  rotors  and  one  using  an 
appended  point-mass  oscillator,  for  which  the  motion  control  problem  is  a  kine¬ 
matic  control  problem.  Using  the  example  of  a  ball  rolling  between  two  rough, 
parallel  plates,  we  illustrated  how  the  methodology  of  this  dissertation  might 
be  applied  to  the  design  of  a  piezo-actuated  vibratory  motor.  We  also  showed 
that,  contrary  to  what  is  typically  done  in  the  nonholonomic  motion  planning 
literature,  mobile  robots  such  as  the  unicycle  and  the  front-wheel  drive  car  are 
naturally  modelled  as  systems  on  Lie  groups.  Thus,  the  methodology  of  this 
dissertation  is  applicable  to  these  systems. 

In  Chapter  4  we  derived  averaging  theory  for  left-invariant  systems  (with  or 
without  drift)  on  finite-dimensional  Lie  groups.  This  is  one  of  the  most  impor¬ 
tant  contributions  of  this  dissertation.  Our  theory  provides  explicit  formulas  for 
approximating  the  system  solution  given  small  (e)  amplitude,  periodically  time- 
varying  (oscillatory)  control  inputs  to  arbitrarily  high  order  in  e.  We  showed  that 
these  formulas  could  be  interpreted  geometrically  as  functions  of  e,  time,  area  and 
moment-like  terms  and  the  structure  constants  associated  to  a  given  basis  for  the 
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relevant  Lie  algebra.  The  area  and  moment  terms  depend  only  on  the  path  of  the 
control  inputs  during  one  period  of  the  oscillation  and  not  on  the  frequency  of 
the  oscillation.  We  emphasized  the  intrinsic  nature  of  these  formulas  by  showing 
that  the  second-order  term  in  the  average  formulas  derives  from  the  curvature 
form  of  a  certain  principal  fiber  bundle  with  connection.  We  also  showed  how 
the  results  of  averaging  of  systems  on  Lie  groups  could  be  used  to  derive  controls 
for  stabilization  of  a  system  equilibrium  point. 

In  Chapter  5  we  developed  a  methodology  for  open-loop  control  synthesis  to 
achieve  point-to-point  system  maneuvers.  This  is  the  second  main  contribution 
of  this  dissertation.  The  methodology  rests  on  the  idea  that  by  controlling  an 
average  solution  exactly  we  will  control  the  system  motion  approximately.  We 
showed  how  controllability  of  the  average  solution  depends  on  the  relationship 
between  the  order  of  the  average  solution  and  the  depth  of  the  Lie  brackets  used  in 
the  Lie  algebra  controllability  rank  condition  for  the  original  system.  We  showed 
how  to  generate  open-loop  controls  by  exploiting  the  geometric  interpretation  of 
the  average  solution  formulas.  Explicit  algorithms  were  derived  and  illustrated 
for  the  examples  of  Chapter  3.  The  algorithms  depend  fundamentally  on  the 
structure  of  the  system  as  described  by  the  structure  constants  for  the  basis 
of  Q  associated  with  the  system’s  control  authority.  If  the  control  authority 
changes  then  the  algorithm  produces  different  control  laws.  We  showed  how 
this  feature  of  our  control  synthesis  methodology  can  be  used  for  adaptation  to 
changes  in  control  authority  such  as  an  actuator  failure.  Finally,  we  described 
experiments  run  to  test  these  algorithms  on  an  autonomous  underwater  vehicle. 
The  experiments  demonstrated  the  potential  for  accurate  motion  control  based 
on  our  methodology. 
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In  Chapter  6  we  applied  our  theory  of  averaging  on  Lie  groups  to  address 
the  control  synthesis  problem  for  bilinear  systems  on  K™.  This  was  motivated 
by  the  fact  that  the  evolution  of  the  state  transition  matrix  of  such  a  system  is 
described  by  a  right-invariant  system  on  a  matrix  Lie  group.  As  an  example  we 
considered  a  switched  electrical  network  that  models  the  conversion  portion  of  a 
dc-dc  voltage  converter  and  the  problem  of  controlling  energy  transfers  between 
dynamic  storage  elements  to  meet  certain  performance  criteria.  The  state  transi¬ 
tion  matrix  for  this  example  system  is  described  by  a  system  with  drift  on  the  Lie 
group  SO  (3).  Using  average  formulas  for  the  state  transition  matrix  evolution 
we  derived  a  controller  design  methodology.  We  illustrated  the  use  of  open-loop 
controls  derived  from  this  methodology  and  successfully  showed  that  the  energy 
in  the  circuit  could  be  transferred  as  desired  with  a  finite  number  of  switchings. 
Open-loop  controls  have  an  advantage  over  purely  feedback  techniques  which 
sometimes  can  lead  to  chattering. 

There  are  several  directions  for  future  research  related  to  the  work  described 
in  this  dissertation.  One  of  these  will  be  to  investigate  the  possibility  of  extending 
our  results  to  systems  on  infinite-dimensional  Lie  groups.  Another  direction  will 
be  to  formalize  the  process  of  combining  open-loop  with  feedback  controls  as 
well  as  adaptation  schemes  using  a  higher  level  supervisory  control  strategy.  If 
we  use  the  open-loop  controls  of  this  dissertation  which  solve  the  motion  control 
problem  with  a  high  order  of  accuracy,  then  we  can  consider  local  feedback  control 
strategies  to  make  the  system  more  robust. 

We  will  also  study  motion  control  problems  which  are  dynamic  rather  than 
kinematic,  i.e.,  for  which  the  control  inputs  are  forces  and  torques  rather  than 
velocities  (e.g.,  see  Baillieul  [6,  5]).  This  will  involve,  among  other  things,  dealing 
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with  a  drift  term  and  motivates  future  research  addressing  control  synthesis  for 
systems  on  Lie  groups  with  a  drift  term  (i.e.,  extending  the  methodology  of 
Chapter  6).  Addressing  the  motion  control  problem  for  systems  with  drift  will 
allow  us  to  consider  control  synthesis  for  bilinear  systems  more  general  than 
the  network  example  of  Chapter  6  as  well  as  for  nonlinear  systems  that  can  be 
approximated  by  bilinear  systems. 

Further  work  will  be  done  to  apply  the  theory  of  averaging  on  Lie  groups  to 
the  problem  of  stabilization  of  a  system  equilibrium  point.  For  example,  we  will 
address  the  problem  of  stabilization  with  periodically  time- varying  controls  when 
m  <  n  controls  are  available  and  n  is  the  dimension  of  the  configuration  space  of 
the  system  (e.g.,  a  Lie  group). 

Additionally,  it  is  of  great  interest  to  continue  experimental  testing  of  our 
algorithms,  particularly  for  a  system  such  as  an  underwater  vehicle  where  there 
are  sensors  which  can  measure  position  and  velocity. 
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